
/*----------------------------------------------------------------------------/
/  FatFs - FAT file system module  R0.07e                    (C)ChaN, 2009
/-----------------------------------------------------------------------------/
/ FatFs module is a generic FAT file system module for small embedded systems.
/ This is a free software that opened for education, research and commercial
/ developments under license policy of following trems.
/
/  Copyright (C) 2009, ChaN, all right reserved.
/
/ * The FatFs module is a free software and there is NO WARRANTY.
/ * No restriction on use. You can use, modify and redistribute it for
/   personal, non-profit or commercial products UNDER YOUR RESPONSIBILITY.
/ * Redistributions of source code must retain the above copyright notice.
/
/-----------------------------------------------------------------------------/
/ Feb 26,'06 R0.00  Prototype.
/
/ Apr 29,'06 R0.01  First stable version.
/
/ Jun 01,'06 R0.02  Added FAT12 support.
/                   Removed unbuffered mode.
/                   Fixed a problem on small (<32M) patition.
/ Jun 10,'06 R0.02a Added a configuration option (_FS_MINIMUM).
/
/ Sep 22,'06 R0.03  Added f_rename().
/                   Changed option _FS_MINIMUM to _FS_MINIMIZE.
/ Dec 11,'06 R0.03a Improved cluster scan algolithm to write files fast.
/                   Fixed f_mkdir() creates incorrect directory on FAT32.
/
/ Feb 04,'07 R0.04  Supported multiple drive system.
/                   Changed some interfaces for multiple drive system.
/                   Changed f_mountdrv() to f_mount().
/                   Added f_mkfs().
/ Apr 01,'07 R0.04a Supported multiple partitions on a plysical drive.
/                   Added a capability of extending file size to f_lseek().
/                   Added minimization level 3.
/                   Fixed an endian sensitive code in f_mkfs().
/ May 05,'07 R0.04b Added a configuration option _USE_NTFLAG.
/                   Added FSInfo support.
/                   Fixed DBCS name can result FR_INVALID_NAME.
/                   Fixed short seek (<= csize) collapses the file object.
/
/ Aug 25,'07 R0.05  Changed arguments of f_read(), f_write() and f_mkfs().
/                   Fixed f_mkfs() on FAT32 creates incorrect FSInfo.
/                   Fixed f_mkdir() on FAT32 creates incorrect directory.
/ Feb 03,'08 R0.05a Added f_truncate() and f_utime().
/                   Fixed off by one error at FAT sub-type determination.
/                   Fixed btr in f_read() can be mistruncated.
/                   Fixed cached sector is not flushed when create and close
/                   without write.
/
/ Apr 01,'08 R0.06  Added fputc(), fputs(), fprintf() and fgets().
/                   Improved performance of f_lseek() on moving to the same
/                   or following cluster.
/
/ Apr 01,'09 R0.07  Merged Tiny-FatFs as a buffer configuration option.
/                   Added long file name support.
/                   Added multiple code page support.
/                   Added re-entrancy for multitask operation.
/                   Added auto cluster size selection to f_mkfs().
/                   Added rewind option to f_readdir().
/                   Changed result code of critical errors.
/                   Renamed string functions to avoid name collision.
/ Apr 14,'09 R0.07a Separated out OS dependent code on reentrant cfg.
/                   Added multiple sector size support.
/ Jun 21,'09 R0.07c Fixed f_unlink() can return FR_OK on error.
/                   Fixed wrong cache control in f_lseek().
/                   Added relative path feature.
/                   Added f_chdir() and f_chdrive().
/                   Added proper case conversion to extended char.
/ Nov 03,'09 R0.07e Separated out configuration options from ff.h to ffconf.h.
/                   Fixed f_unlink() fails to remove a sub-dir on _FS_RPATH.
/                   Fixed name matching error on the 13 char boundary.
/                   Added a configuration option, _LFN_UNICODE.
/                   Changed f_readdir() to return the SFN with always upper
/                   case on non-LFN cfg.
/---------------------------------------------------------------------------*/

#include "ff.h"         /* FatFs configurations and declarations */
#include "diskio.h"     /* Declarations of low level disk I/O functions */

extern void neo_copyto_myth_psram(unsigned char *src, int pstart, int len);

/*--------------------------------------------------------------------------

   Module Private Definitions

---------------------------------------------------------------------------*/

#if _FATFS != 0x007E
#error Wrong include file (ff.h).
#endif

#if _FS_REENTRANT
#if _USE_LFN == 1
#error Static LFN work area must not be used in re-entrant configuration.
#endif
#define ENTER_FF(fs)        { if (!lock_fs(fs)) return FR_TIMEOUT; }
#define LEAVE_FF(fs, res)   { unlock_fs(fs, res); return res; }

#else
#define ENTER_FF(fs)
#define LEAVE_FF(fs, res)   return res

#endif

#define ABORT(fs, res)      { fp->flag |= FA__ERROR; LEAVE_FF(fs, res); }

#ifndef NULL
#define NULL    0
#endif

/* Name status flags */
#define NS          11      /* Offset of name status byte */
#define NS_LOSS     0x01    /* Out of 8.3 format */
#define NS_LFN      0x02    /* Force to create LFN entry */
#define NS_LAST     0x04    /* Last segment */
#define NS_BODY     0x08    /* Lower case flag (body) */
#define NS_EXT      0x10    /* Lower case flag (ext) */
#define NS_DOT      0x20    /* Dot entry */




/*--------------------------------------------------------------------------

   Private Work Area

---------------------------------------------------------------------------*/

#if _DRIVES < 1 || _DRIVES > 9
#error Number of drives must be 1-9.
#endif
static
FATFS *FatFs[_DRIVES];  /* Pointer to the file system objects (logical drives) */

static
WORD Fsid;              /* File system mount ID */

#if _FS_RPATH
static
BYTE Drive;             /* Current drive */
#endif


#if _USE_LFN == 1   /* LFN with static LFN working buffer */
static
WCHAR LfnBuf[_MAX_LFN + 1];
#define NAMEBUF(sp,lp)  BYTE sp[12]; WCHAR *lp = LfnBuf
#define INITBUF(dj,sp,lp)   dj.fn = sp; dj.lfn = lp

#elif _USE_LFN > 1  /* LFN with dynamic LFN working buffer */
#define NAMEBUF(sp,lp)  BYTE sp[12]; WCHAR lbuf[_MAX_LFN + 1], *lp = lbuf
#define INITBUF(dj,sp,lp)   dj.fn = sp; dj.lfn = lp

#else               /* No LFN */
#define NAMEBUF(sp,lp)  BYTE sp[12]
#define INITBUF(dj,sp,lp)   dj.fn = sp

#endif




/*--------------------------------------------------------------------------

   Module Private Functions

---------------------------------------------------------------------------*/


/*-----------------------------------------------------------------------*/
/* String functions                                                      */
/*-----------------------------------------------------------------------*/

/*Genesis optimized code*/
extern void mem_cpy (void* dst, const void* src, int cnt);
extern void mem_set (void* dst, int val, int cnt);
extern int chk_chr (const char* str, int chr);
extern int mem_cmp (const void* dst, const void* src, int cnt);

/*
static
void mem_cpy (void* dst, const void* src, int cnt) {
    char *d = (char*)dst;
    const char *s = (const char *)src;
    while (cnt--) *d++ = *s++;
}

static
void mem_set (void* dst, int val, int cnt) {
    char *d = (char*)dst;
    while (cnt--) *d++ = (char)val;
}

static
int chk_chr (const char* str, int chr) {
    while (*str && *str != chr) str++;
    return *str;
}


static
int mem_cmp (const void* dst, const void* src, int cnt) {
    const char *d = (const char *)dst, *s = (const char *)src;
    int r = 0;
    while (cnt-- && (r = *d++ - *s++) == 0) ;
    return r;
}
*/

/*-----------------------------------------------------------------------*/
/* Request/Release grant to access the volume                            */
/*-----------------------------------------------------------------------*/
#if _FS_REENTRANT

static
BOOL lock_fs (
    FATFS *fs       /* File system object */
)
{
    return ff_req_grant(fs->sobj);
}


static
void unlock_fs (
    FATFS *fs,      /* File system object */
    FRESULT res     /* Result code to be returned */
)
{
    if (res != FR_NOT_ENABLED &&
        res != FR_INVALID_DRIVE &&
        res != FR_INVALID_OBJECT &&
        res != FR_TIMEOUT) {
        ff_rel_grant(fs->sobj);
    }
}
#endif



/*-----------------------------------------------------------------------*/
/* Change window offset                                                  */
/*-----------------------------------------------------------------------*/

static
FRESULT move_window (
    FATFS *fs,      /* File system object */
    DWORD sector    /* Sector number to make apperance in the fs->win[] */
)                   /* Move to zero only writes back dirty window */
{
    DWORD wsect;


    wsect = fs->winsect;
    if (wsect != sector) {  /* Changed current window */
#if !_FS_READONLY
        if (fs->wflag) {    /* Write back dirty window if needed */
            if (disk_write(fs->drive, fs->win, wsect, 1) != RES_OK)
                return FR_DISK_ERR;
            fs->wflag = 0;
            if (wsect < (fs->fatbase + fs->sects_fat)) {    /* In FAT area */
                BYTE nf;
                for (nf = fs->n_fats; nf > 1; nf--) {   /* Refrect the change to all FAT copies */
                    wsect += fs->sects_fat;
                    disk_write(fs->drive, fs->win, wsect, 1);
                }
            }
        }
#endif
        if (sector) {
            if (disk_read(fs->drive, fs->win, sector, 1) != RES_OK)
                return FR_DISK_ERR;
            fs->winsect = sector;
        }
    }

    return FR_OK;
}




/*-----------------------------------------------------------------------*/
/* Clean-up cached data                                                  */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY
static
FRESULT sync (  /* FR_OK: successful, FR_DISK_ERR: failed */
    FATFS *fs   /* File system object */
)
{
    FRESULT res;


    res = move_window(fs, 0);
    if (res == FR_OK) {
        /* Update FSInfo sector if needed */
        if (fs->fs_type == FS_FAT32 && fs->fsi_flag) {
            fs->winsect = 0;
            mem_set(fs->win, 0, 512);
            ST_WORD(fs->win+BS_55AA, 0xAA55);
            ST_DWORD(fs->win+FSI_LeadSig, 0x41615252);
            ST_DWORD(fs->win+FSI_StrucSig, 0x61417272);
            ST_DWORD(fs->win+FSI_Free_Count, fs->free_clust);
            ST_DWORD(fs->win+FSI_Nxt_Free, fs->last_clust);
            disk_write(fs->drive, fs->win, fs->fsi_sector, 1);
            fs->fsi_flag = 0;
        }
        /* Make sure that no pending write process in the physical drive */
        if (disk_ioctl(fs->drive, CTRL_SYNC, (void*)NULL) != RES_OK)
            res = FR_DISK_ERR;
    }

    return res;
}
#endif




/*-----------------------------------------------------------------------*/
/* FAT access - Read value of a FAT entry                                */
/*-----------------------------------------------------------------------*/


DWORD get_fat ( /* 0xFFFFFFFF:Disk error, 1:Interal error, Else:Cluster status */
    FATFS *fs,  /* File system object */
    DWORD clst  /* Cluster# to get the link information */
)
{
    UINT wc, bc;
    DWORD fsect;


    if (clst < 2 || clst >= fs->max_clust)  /* Range check */
        return 1;

    fsect = fs->fatbase;
    switch (fs->fs_type) {
    case FS_FAT12 :
        bc = clst; bc += bc / 2;
        if (move_window(fs, fsect + (bc / SS(fs)))) break;
        wc = fs->win[bc & (SS(fs) - 1)]; bc++;
        if (move_window(fs, fsect + (bc / SS(fs)))) break;
        wc |= (WORD)fs->win[bc & (SS(fs) - 1)] << 8;
        return (clst & 1) ? (wc >> 4) : (wc & 0xFFF);

    case FS_FAT16 :
        if (move_window(fs, fsect + (clst / (SS(fs) / 2)))) break;
        return LD_WORD(&fs->win[((WORD)clst * 2) & (SS(fs) - 1)]);

    case FS_FAT32 :
        if (move_window(fs, fsect + (clst / (SS(fs) / 4)))) break;
        return LD_DWORD(&fs->win[((WORD)clst * 4) & (SS(fs) - 1)]) & 0x0FFFFFFF;
    }

    return 0xFFFFFFFF;  /* An error occured at the disk I/O layer */
}




/*-----------------------------------------------------------------------*/
/* FAT access - Change value of a FAT entry                              */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY

FRESULT put_fat (
    FATFS *fs,  /* File system object */
    DWORD clst, /* Cluster# to be changed in range of 2 to fs->max_clust - 1 */
    DWORD val   /* New value to mark the cluster */
)
{
    UINT bc;
    BYTE *p;
    DWORD fsect;
    FRESULT res;


    if (clst < 2 || clst >= fs->max_clust) {    /* Range check */
        res = FR_INT_ERR;

    } else {
        fsect = fs->fatbase;
        switch (fs->fs_type) {
        case FS_FAT12 :
            bc = clst; bc += bc / 2;
            res = move_window(fs, fsect + (bc / SS(fs)));
            if (res != FR_OK) break;
            p = &fs->win[bc & (SS(fs) - 1)];
            *p = (clst & 1) ? ((*p & 0x0F) | ((BYTE)val << 4)) : (BYTE)val;
            bc++;
            fs->wflag = 1;
            res = move_window(fs, fsect + (bc / SS(fs)));
            if (res != FR_OK) break;
            p = &fs->win[bc & (SS(fs) - 1)];
            *p = (clst & 1) ? (BYTE)(val >> 4) : ((*p & 0xF0) | ((BYTE)(val >> 8) & 0x0F));
            break;

        case FS_FAT16 :
            res = move_window(fs, fsect + (clst / (SS(fs) / 2)));
            if (res != FR_OK) break;
            ST_WORD(&fs->win[((WORD)clst * 2) & (SS(fs) - 1)], (WORD)val);
            break;

        case FS_FAT32 :
            res = move_window(fs, fsect + (clst / (SS(fs) / 4)));
            if (res != FR_OK) break;
            ST_DWORD(&fs->win[((WORD)clst * 4) & (SS(fs) - 1)], val);
            break;

        default :
            res = FR_INT_ERR;
        }
        fs->wflag = 1;
    }

    return res;
}
#endif /* !_FS_READONLY */




/*-----------------------------------------------------------------------*/
/* FAT handling - Remove a cluster chain                                 */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY
static
FRESULT remove_chain (
    FATFS *fs,          /* File system object */
    DWORD clst          /* Cluster# to remove a chain from */
)
{
    FRESULT res;
    DWORD nxt;


    if (clst < 2 || clst >= fs->max_clust) {    /* Check the range of cluster# */
        res = FR_INT_ERR;

    } else {
        res = FR_OK;
        while (clst < fs->max_clust) {          /* Not a last link? */
            nxt = get_fat(fs, clst);            /* Get cluster status */
            if (nxt == 0) break;                /* Empty cluster? */
            if (nxt == 1) { res = FR_INT_ERR; break; }  /* Internal error? */
            if (nxt == 0xFFFFFFFF) { res = FR_DISK_ERR; break; }    /* Disk error? */
            res = put_fat(fs, clst, 0);         /* Mark the cluster "empty" */
            if (res != FR_OK) break;
            if (fs->free_clust != 0xFFFFFFFF) { /* Update FSInfo */
                fs->free_clust++;
                fs->fsi_flag = 1;
            }
            clst = nxt; /* Next cluster */
        }
    }

    return res;
}
#endif




/*-----------------------------------------------------------------------*/
/* FAT handling - Stretch or Create a cluster chain                      */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY
static
DWORD create_chain (    /* 0:No free cluster, 1:Internal error, 0xFFFFFFFF:Disk error, >=2:New cluster# */
    FATFS *fs,          /* File system object */
    DWORD clst          /* Cluster# to stretch. 0 means create a new chain. */
)
{
    DWORD cs, ncl, scl, mcl;


    mcl = fs->max_clust;
    if (clst == 0) {        /* Create new chain */
        scl = fs->last_clust;           /* Get suggested start point */
        if (scl == 0 || scl >= mcl) scl = 1;
    }
    else {                  /* Stretch existing chain */
        cs = get_fat(fs, clst);         /* Check the cluster status */
        if (cs < 2) return 1;           /* It is an invalid cluster */
        if (cs < mcl) return cs;        /* It is already followed by next cluster */
        scl = clst;
    }

    ncl = scl;              /* Start cluster */
    for (;;) {
        ncl++;                          /* Next cluster */
        if (ncl >= mcl) {               /* Wrap around */
            ncl = 2;
            if (ncl > scl) return 0;    /* No free custer */
        }
        cs = get_fat(fs, ncl);          /* Get the cluster status */
        if (cs == 0) break;             /* Found a free cluster */
        if (cs == 0xFFFFFFFF || cs == 1)/* An error occured */
            return cs;
        if (ncl == scl) return 0;       /* No free custer */
    }

    if (put_fat(fs, ncl, 0x0FFFFFFF))   /* Mark the new cluster "in use" */
        return 0xFFFFFFFF;
    if (clst != 0) {                    /* Link it to the previous one if needed */
        if (put_fat(fs, clst, ncl))
            return 0xFFFFFFFF;
    }

    fs->last_clust = ncl;               /* Update FSINFO */
    if (fs->free_clust != 0xFFFFFFFF) {
        fs->free_clust--;
        fs->fsi_flag = 1;
    }

    return ncl;     /* Return new cluster number */
}
#endif /* !_FS_READONLY */




/*-----------------------------------------------------------------------*/
/* Get sector# from cluster#                                             */
/*-----------------------------------------------------------------------*/


DWORD clust2sect (  /* !=0: Sector number, 0: Failed - invalid cluster# */
    FATFS *fs,      /* File system object */
    DWORD clst      /* Cluster# to be converted */
)
{
    clst -= 2;
    if (clst >= (fs->max_clust - 2)) return 0;      /* Invalid cluster# */
    return clst * fs->csize + fs->database;
}




/*-----------------------------------------------------------------------*/
/* Directory handling - Seek directory index                             */
/*-----------------------------------------------------------------------*/

static
FRESULT dir_seek (
    DIR *dj,        /* Pointer to directory object */
    WORD idx        /* Directory index number */
)
{
    DWORD clst;
    WORD ic;


    dj->index = idx;
    clst = dj->sclust;
    if (clst == 1 || clst >= dj->fs->max_clust) /* Check start cluster range */
        return FR_INT_ERR;
    if (!clst && dj->fs->fs_type == FS_FAT32)   /* Replace cluster# 0 with root cluster# if in FAT32 */
        clst = dj->fs->dirbase;

    if (clst == 0) {    /* Static table */
        dj->clust = clst;
        if (idx >= dj->fs->n_rootdir)       /* Index is out of range */
            return FR_INT_ERR;
        dj->sect = dj->fs->dirbase + idx / (SS(dj->fs) / 32);   /* Sector# */
    }
    else {              /* Dynamic table */
        ic = SS(dj->fs) / 32 * dj->fs->csize;   /* Entries per cluster */
        while (idx >= ic) { /* Follow cluster chain */
            clst = get_fat(dj->fs, clst);               /* Get next cluster */
            if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */
            if (clst < 2 || clst >= dj->fs->max_clust)  /* Reached to end of table or int error */
                return FR_INT_ERR;
            idx -= ic;
        }
        dj->clust = clst;
        dj->sect = clust2sect(dj->fs, clst) + idx / (SS(dj->fs) / 32);  /* Sector# */
    }

    dj->dir = dj->fs->win + (idx % (SS(dj->fs) / 32)) * 32; /* Ptr to the entry in the sector */

    return FR_OK;   /* Seek succeeded */
}




/*-----------------------------------------------------------------------*/
/* Directory handling - Move directory index next                        */
/*-----------------------------------------------------------------------*/

static
FRESULT dir_next (  /* FR_OK:Succeeded, FR_NO_FILE:End of table, FR_DENIED:EOT and could not streach */
    DIR *dj,        /* Pointer to directory object */
    BOOL streach    /* FALSE: Do not streach table, TRUE: Streach table if needed */
)
{
    DWORD clst;
    WORD i;


    i = dj->index + 1;
    if (!i || !dj->sect)    /* Report EOT when index has reached 65535 */
        return FR_NO_FILE;

    if (!(i % (SS(dj->fs) / 32))) { /* Sector changed? */
        dj->sect++;                 /* Next sector */

        if (dj->clust == 0) {   /* Static table */
            if (i >= dj->fs->n_rootdir) /* Report EOT when end of table */
                return FR_NO_FILE;
        }
        else {                  /* Dynamic table */
            if (((i / (SS(dj->fs) / 32)) & (dj->fs->csize - 1)) == 0) { /* Cluster changed? */
                clst = get_fat(dj->fs, dj->clust);              /* Get next cluster */
                if (clst <= 1) return FR_INT_ERR;
                if (clst == 0xFFFFFFFF) return FR_DISK_ERR;
                if (clst >= dj->fs->max_clust) {                /* When it reached end of dynamic table */
#if !_FS_READONLY
                    BYTE c;
                    if (!streach) return FR_NO_FILE;            /* When do not streach, report EOT */
                    clst = create_chain(dj->fs, dj->clust);     /* Streach cluster chain */
                    if (clst == 0) return FR_DENIED;            /* No free cluster */
                    if (clst == 1) return FR_INT_ERR;
                    if (clst == 0xFFFFFFFF) return FR_DISK_ERR;
                    /* Clean-up streached table */
                    if (move_window(dj->fs, 0)) return FR_DISK_ERR; /* Flush active window */
                    mem_set(dj->fs->win, 0, SS(dj->fs));            /* Clear window buffer */
                    dj->fs->winsect = clust2sect(dj->fs, clst); /* Cluster start sector */
                    for (c = 0; c < dj->fs->csize; c++) {       /* Fill the new cluster with 0 */
                        dj->fs->wflag = 1;
                        if (move_window(dj->fs, 0)) return FR_DISK_ERR;
                        dj->fs->winsect++;
                    }
                    dj->fs->winsect -= c;                       /* Rewind window address */
#else
                    return FR_NO_FILE;          /* Report EOT */
#endif
                }
                dj->clust = clst;               /* Initialize data for new cluster */
                dj->sect = clust2sect(dj->fs, clst);
            }
        }
    }

    dj->index = i;
    dj->dir = dj->fs->win + (i % (SS(dj->fs) / 32)) * 32;

    return FR_OK;
}




/*-----------------------------------------------------------------------*/
/* LFN handling - Test/Pick/Fit an LFN segment from/to directory entry   */
/*-----------------------------------------------------------------------*/
#if _USE_LFN
static
const BYTE LfnOfs[] = {1,3,5,7,9,14,16,18,20,22,24,28,30};  /* Offset of LFN chars in the directory entry */


static
BOOL cmp_lfn (          /* TRUE:Matched, FALSE:Not matched */
    WCHAR *lfnbuf,      /* Pointer to the LFN to be compared */
    BYTE *dir           /* Pointer to the directory entry containing a part of LFN */
)
{
    int i, s;
    WCHAR wc, uc;


    i = ((dir[LDIR_Ord] & 0xBF) - 1) * 13;  /* Get offset in the LFN buffer */
    s = 0; wc = 1;
    do {
        uc = LD_WORD(dir+LfnOfs[s]);    /* Pick an LFN character from the entry */
        if (wc) {   /* Last char has not been processed */
            wc = ff_wtoupper(uc);       /* Convert it to upper case */
            if (i >= _MAX_LFN || wc != ff_wtoupper(lfnbuf[i++]))    /* Compare it */
                return FALSE;           /* Not matched */
        } else {
            if (uc != 0xFFFF) return FALSE; /* Check filler */
        }
    } while (++s < 13);             /* Repeat until all chars in the entry are checked */

    if ((dir[LDIR_Ord] & 0x40) && wc && lfnbuf[i])  /* Last segment matched but different length */
        return FALSE;

    return TRUE;                    /* The part of LFN matched */
}



static
BOOL pick_lfn (         /* TRUE:Succeeded, FALSE:Buffer overflow */
    WCHAR *lfnbuf,      /* Pointer to the Unicode-LFN buffer */
    BYTE *dir           /* Pointer to the directory entry */
)
{
    int i, s;
    WCHAR wc, uc;


    i = ((dir[LDIR_Ord] & 0x3F) - 1) * 13;  /* Offset in the LFN buffer */

    s = 0; wc = 1;
    do {
        uc = LD_WORD(dir+LfnOfs[s]);            /* Pick an LFN character from the entry */
        if (wc) {   /* Last char has not been processed */
            if (i >= _MAX_LFN) return FALSE;    /* Buffer overflow? */
            lfnbuf[i++] = wc = uc;              /* Store it */
        } else {
            if (uc != 0xFFFF) return FALSE;     /* Check filler */
        }
    } while (++s < 13);                     /* Read all character in the entry */

    if (dir[LDIR_Ord] & 0x40) {             /* Put terminator if it is the last LFN part */
        if (i >= _MAX_LFN) return FALSE;    /* Buffer overflow? */
        lfnbuf[i] = 0;
    }

    return TRUE;
}


#if !_FS_READONLY
static
void fit_lfn (
    const WCHAR *lfnbuf,    /* Pointer to the LFN buffer */
    BYTE *dir,              /* Pointer to the directory entry */
    BYTE ord,               /* LFN order (1-20) */
    BYTE sum                /* SFN sum */
)
{
    int i, s;
    WCHAR wc;


    dir[LDIR_Chksum] = sum;         /* Set check sum */
    dir[LDIR_Attr] = AM_LFN;        /* Set attribute. LFN entry */
    dir[LDIR_Type] = 0;
    ST_WORD(dir+LDIR_FstClusLO, 0);

    i = (ord - 1) * 13;             /* Get offset in the LFN buffer */
    s = wc = 0;
    do {
        if (wc != 0xFFFF) wc = lfnbuf[i++]; /* Get an effective char */
        ST_WORD(dir+LfnOfs[s], wc); /* Put it */
        if (!wc) wc = 0xFFFF;       /* Padding chars following last char */
    } while (++s < 13);
    if (wc == 0xFFFF || !lfnbuf[i]) ord |= 0x40;    /* Bottom LFN part is the start of LFN sequence */
    dir[LDIR_Ord] = ord;            /* Set the LFN order */
}

#endif
#endif



/*-----------------------------------------------------------------------*/
/* Create numbered name                                                  */
/*-----------------------------------------------------------------------*/
#if _USE_LFN
void gen_numname (
    BYTE *dst,          /* Pointer to genartated SFN */
    const BYTE *src,    /* Pointer to source SFN to be modified */
    const WCHAR *lfn,   /* Pointer to LFN */
    WORD num            /* Sequense number */
)
{
    char ns[8];
    int i, j;


    mem_cpy(dst, src, 11);

    if (num > 5) {  /* On many collisions, generate a hash number instead of sequencial number */
        do num = (num >> 1) + (num << 15) + (WORD)*lfn++; while (*lfn);
    }

    /* itoa */
    i = 7;
    do {
        ns[i--] = (num % 10) + '0';
        num /= 10;
    } while (num);
    ns[i] = '~';

    /* Append the number */
    for (j = 0; j < i && dst[j] != ' '; j++) {
        if (IsDBCS1(dst[j])) {
            if (j == i - 1) break;
            j++;
        }
    }
    do {
        dst[j++] = (i < 8) ? ns[i++] : ' ';
    } while (j < 8);
}
#endif




/*-----------------------------------------------------------------------*/
/* Calculate sum of an SFN                                               */
/*-----------------------------------------------------------------------*/
#if _USE_LFN
static
BYTE sum_sfn (
    const BYTE *dir     /* Ptr to directory entry */
)
{
    BYTE sum = 0;
    int n = 11;

    do sum = (sum >> 1) + (sum << 7) + *dir++; while (--n);
    return sum;
}
#endif




/*-----------------------------------------------------------------------*/
/* Directory handling - Find an object in the directory                  */
/*-----------------------------------------------------------------------*/

static
FRESULT dir_find (
    DIR *dj         /* Pointer to the directory object linked to the file name */
)
{
    FRESULT res;
    BYTE c, *dir;
#if _USE_LFN
    BYTE a, ord, sum;
#endif

    res = dir_seek(dj, 0);          /* Rewind directory object */
    if (res != FR_OK) return res;

#if _USE_LFN
    ord = sum = 0xFF;
#endif
    do {
        res = move_window(dj->fs, dj->sect);
        if (res != FR_OK) break;
        dir = dj->dir;                  /* Ptr to the directory entry of current index */
        c = dir[DIR_Name];
        if (c == 0) { res = FR_NO_FILE; break; }    /* Reached to end of table */
#if _USE_LFN    /* LFN configuration */
        a = dir[DIR_Attr] & AM_MASK;
        if (c == 0xE5 || ((a & AM_VOL) && a != AM_LFN)) {   /* An entry without valid data */
            ord = 0xFF;
        } else {
            if (a == AM_LFN) {          /* An LFN entry is found */
                if (dj->lfn) {
                    if (c & 0x40) {     /* Is it start of LFN sequence? */
                        sum = dir[LDIR_Chksum];
                        c &= 0xBF; ord = c; /* LFN start order */
                        dj->lfn_idx = dj->index;
                    }
                    /* Check validity of the LFN entry and compare it with given name */
                    ord = (c == ord && sum == dir[LDIR_Chksum] && cmp_lfn(dj->lfn, dir)) ? ord - 1 : 0xFF;
                }
            } else {                    /* An SFN entry is found */
                if (!ord && sum == sum_sfn(dir)) break; /* LFN matched? */
                ord = 0xFF; dj->lfn_idx = 0xFFFF;   /* Reset LFN sequence */
                if (!(dj->fn[NS] & NS_LOSS) && !mem_cmp(dir, dj->fn, 11)) break;    /* SFN matched? */
            }
        }
#else       /* Non LFN configuration */
        if (!(dir[DIR_Attr] & AM_VOL) && !mem_cmp(dir, dj->fn, 11)) /* Is it a valid entry? */
            break;
#endif
        res = dir_next(dj, FALSE);      /* Next entry */
    } while (res == FR_OK);

    return res;
}




/*-----------------------------------------------------------------------*/
/* Read an object from the directory                                     */
/*-----------------------------------------------------------------------*/
#if _FS_MINIMIZE <= 1
static
FRESULT dir_read (
    DIR *dj         /* Pointer to the directory object that pointing the entry to be read */
)
{
    FRESULT res;
    BYTE c, *dir;
#if _USE_LFN
    BYTE a, ord = 0xFF, sum = 0xFF;
#endif

    res = FR_NO_FILE;
    while (dj->sect) {
        res = move_window(dj->fs, dj->sect);
        if (res != FR_OK) break;
        dir = dj->dir;                  /* Ptr to the directory entry of current index */
        c = dir[DIR_Name];
        if (c == 0) { res = FR_NO_FILE; break; }    /* Reached to end of table */
#if _USE_LFN    /* LFN configuration */
        a = dir[DIR_Attr] & AM_MASK;
        if (c == 0xE5 || (!_FS_RPATH && c == '.') || ((a & AM_VOL) && a != AM_LFN)) {   /* An entry without valid data */
            ord = 0xFF;
        } else {
            if (a == AM_LFN) {          /* An LFN entry is found */
                if (c & 0x40) {         /* Is it start of LFN sequence? */
                    sum = dir[LDIR_Chksum];
                    c &= 0xBF; ord = c;
                    dj->lfn_idx = dj->index;
                }
                /* Check LFN validity and capture it */
                ord = (c == ord && sum == dir[LDIR_Chksum] && pick_lfn(dj->lfn, dir)) ? ord - 1 : 0xFF;
            } else {                    /* An SFN entry is found */
                if (ord || sum != sum_sfn(dir)) /* Is there a valid LFN? */
                    dj->lfn_idx = 0xFFFF;       /* It has no LFN. */
                break;
            }
        }
#else       /* Non LFN configuration */
        if (c != 0xE5 && (_FS_RPATH || c != '.') && !(dir[DIR_Attr] & AM_VOL))  /* Is it a valid entry? */
            break;
#endif
        res = dir_next(dj, FALSE);              /* Next entry */
        if (res != FR_OK) break;
    }

    if (res != FR_OK) dj->sect = 0;

    return res;
}
#endif



/*-----------------------------------------------------------------------*/
/* Register an object to the directory                                   */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY
static
FRESULT dir_register (  /* FR_OK:Successful, FR_DENIED:No free entry or too many SFN collision, FR_DISK_ERR:Disk error */
    DIR *dj             /* Target directory with object name to be created */
)
{
    FRESULT res;
    BYTE c, *dir;
#if _USE_LFN    /* LFN configuration */
    WORD n, ne, is;
    BYTE sn[12], *fn, sum;
    WCHAR *lfn;


    fn = dj->fn; lfn = dj->lfn;
    mem_cpy(sn, fn, 12);

    if (_FS_RPATH && (sn[NS] & NS_DOT)) return FR_INVALID_NAME; /* Cannot create dot entry */

    if (sn[NS] & NS_LOSS) {         /* When LFN is out of 8.3 format, generate a numbered name */
        fn[NS] = 0; dj->lfn = NULL;         /* Find only SFN */
        for (n = 1; n < 100; n++) {
            gen_numname(fn, sn, lfn, n);    /* Generate a numbered name */
            res = dir_find(dj);             /* Check if the name collides with existing SFN */
            if (res != FR_OK) break;
        }
        if (n == 100) return FR_DENIED;     /* Abort if too many collisions */
        if (res != FR_NO_FILE) return res;  /* Abort if the result is other than 'not collided' */
        fn[NS] = sn[NS]; dj->lfn = lfn;
    }

    if (sn[NS] & NS_LFN) {          /* When LFN is to be created, reserve reserve an SFN + LFN entries. */
        for (ne = 0; lfn[ne]; ne++) ;
        ne = (ne + 25) / 13;
    } else {                        /* Otherwise reserve only an SFN entry. */
        ne = 1;
    }

    /* Reserve contiguous entries */
    res = dir_seek(dj, 0);
    if (res != FR_OK) return res;
    n = is = 0;
    do {
        res = move_window(dj->fs, dj->sect);
        if (res != FR_OK) break;
        c = *dj->dir;               /* Check the entry status */
        if (c == 0xE5 || c == 0) {  /* Is it a blank entry? */
            if (n == 0) is = dj->index; /* First index of the contigulus entry */
            if (++n == ne) break;   /* A contiguous entry that requiered count is found */
        } else {
            n = 0;                  /* Not a blank entry. Restart to search */
        }
        res = dir_next(dj, TRUE);   /* Next entry with table streach */
    } while (res == FR_OK);

    if (res == FR_OK && ne > 1) {   /* Initialize LFN entry if needed */
        res = dir_seek(dj, is);
        if (res == FR_OK) {
            sum = sum_sfn(dj->fn);  /* Sum of the SFN tied to the LFN */
            ne--;
            do {                    /* Store LFN entries in bottom first */
                res = move_window(dj->fs, dj->sect);
                if (res != FR_OK) break;
                fit_lfn(dj->lfn, dj->dir, (BYTE)ne, sum);
                dj->fs->wflag = 1;
                res = dir_next(dj, FALSE);  /* Next entry */
            } while (res == FR_OK && --ne);
        }
    }

#else   /* Non LFN configuration */
    res = dir_seek(dj, 0);
    if (res == FR_OK) {
        do {    /* Find a blank entry for the SFN */
            res = move_window(dj->fs, dj->sect);
            if (res != FR_OK) break;
            c = *dj->dir;
            if (c == 0xE5 || c == 0) break; /* Is it a blank entry? */
            res = dir_next(dj, TRUE);       /* Next entry with table streach */
        } while (res == FR_OK);
    }
#endif

    if (res == FR_OK) {     /* Initialize the SFN entry */
        res = move_window(dj->fs, dj->sect);
        if (res == FR_OK) {
            dir = dj->dir;
            mem_set(dir, 0, 32);        /* Clean the entry */
            mem_cpy(dir, dj->fn, 11);   /* Put SFN */
            dir[DIR_NTres] = *(dj->fn+NS) & (NS_BODY | NS_EXT); /* Put NT flag */
            dj->fs->wflag = 1;
        }
    }

    return res;
}
#endif /* !_FS_READONLY */




/*-----------------------------------------------------------------------*/
/* Remove an object from the directory                                   */
/*-----------------------------------------------------------------------*/
#if !_FS_READONLY && !_FS_MINIMIZE
static
FRESULT dir_remove (    /* FR_OK: Successful, FR_DISK_ERR: A disk error */
    DIR *dj             /* Directory object pointing the entry to be removed */
)
{
    FRESULT res;
#if _USE_LFN    /* LFN configuration */
    WORD i;

    i = dj->index;  /* SFN index */
    res = dir_seek(dj, (WORD)((dj->lfn_idx == 0xFFFF) ? i : dj->lfn_idx));  /* Goto the SFN or top of the LFN entries */
    if (res == FR_OK) {
        do {
            res = move_window(dj->fs, dj->sect);
            if (res != FR_OK) break;
            *dj->dir = 0xE5;            /* Mark the entry "deleted" */
            dj->fs->wflag = 1;
            if (dj->index >= i) break;  /* When reached SFN, all entries of the object has been deleted. */
            res = dir_next(dj, FALSE);  /* Next entry */
        } while (res == FR_OK);
        if (res == FR_NO_FILE) res = FR_INT_ERR;
    }

#else           /* Non LFN configuration */
    res = dir_seek(dj, dj->index);
    if (res == FR_OK) {
        res = move_window(dj->fs, dj->sect);
        if (res == FR_OK) {
            *dj->dir = 0xE5;            /* Mark the entry "deleted" */
            dj->fs->wflag = 1;
        }
    }
#endif

    return res;
}
#endif /* !_FS_READONLY */




/*-----------------------------------------------------------------------*/
/* Pick a segment and create the object name in directory form           */
/*-----------------------------------------------------------------------*/

static
FRESULT create_name (
    DIR *dj,            /* Pointer to the directory object */
    const XCHAR **path  /* Pointer to pointer to the segment in the path string */
)
{
#ifdef _EXCVT
    static const BYTE cvt[] = _EXCVT;
#endif

#if _USE_LFN    /* LFN configuration */
    BYTE b, cf;
    WCHAR w, *lfn;
    int i, ni, si, di;
    const XCHAR *p;

    /* Create LFN in Unicode */
    si = di = 0;
    p = *path;
    lfn = dj->lfn;
    for (;;) {
        w = p[si++];                    /* Get a character */
        if (w < ' ' || w == '/' || w == '\\') break;    /* Break on end of segment */
        if (di >= _MAX_LFN)             /* Reject too long name */
            return FR_INVALID_NAME;
#if !_LFN_UNICODE
        w &= 0xFF;
        if (IsDBCS1(w)) {               /* If it is a DBC 1st byte */
            b = p[si++];                /* Get 2nd byte */
            if (!IsDBCS2(b))            /* Reject invalid code for DBC */
                return FR_INVALID_NAME;
            w = (w << 8) + b;
        }
        w = ff_convert(w, 1);           /* Convert OEM to Unicode */
        if (!w) return FR_INVALID_NAME; /* Reject invalid code */
#endif
        if (w < 0x80 && chk_chr("\"*:<>\?|\x7F", w)) /* Reject illegal chars for LFN */
            return FR_INVALID_NAME;
        lfn[di++] = w;                  /* Store the Unicode char */
    }
    *path = &p[si];                     /* Rerurn pointer to the next segment */
    cf = (w < ' ') ? NS_LAST : 0;       /* Set last segment flag if end of path */
#if _FS_RPATH
    if ((di == 1 && lfn[di - 1] == '.') || /* Is this a dot entry? */
        (di == 2 && lfn[di - 1] == '.' && lfn[di - 2] == '.')) {
        lfn[di] = 0;
        for (i = 0; i < 11; i++)
            dj->fn[i] = (i < di) ? '.' : ' ';
        dj->fn[i] = cf | NS_DOT;        /* This is a dot entry */
        return FR_OK;
    }
#endif
    while (di) {                        /* Strip trailing spaces and dots */
        w = lfn[di - 1];
        if (w != ' ' && w != '.') break;
        di--;
    }
    if (!di) return FR_INVALID_NAME;    /* Reject null string */

    lfn[di] = 0;                        /* LFN is created */

    /* Create SFN in directory form */
    mem_set(dj->fn, ' ', 11);
    for (si = 0; lfn[si] == ' ' || lfn[si] == '.'; si++) ;  /* Strip leading spaces and dots */
    if (si) cf |= NS_LOSS | NS_LFN;
    while (di && lfn[di - 1] != '.') di--;  /* Find extension (di<=si: no extension) */

    b = i = 0; ni = 8;
    for (;;) {
        w = lfn[si++];                  /* Get an LFN char */
        if (!w) break;                  /* Break on enf of the LFN */
        if (w == ' ' || (w == '.' && si != di)) {   /* Remove spaces and dots */
            cf |= NS_LOSS | NS_LFN; continue;
        }

        if (i >= ni || si == di) {      /* Extension or end of SFN */
            if (ni == 11) {             /* Long extension */
                cf |= NS_LOSS | NS_LFN; break;
            }
            if (si != di) cf |= NS_LOSS | NS_LFN;   /* Out of 8.3 format */
            if (si > di) break;         /* No extension */
            si = di; i = 8; ni = 11;    /* Enter extension section */
            b <<= 2; continue;
        }

        if (w >= 0x80) {                /* Non ASCII char */
#ifdef _EXCVT
            w = ff_convert(w, 0);       /* Unicode -> OEM code */
            if (w) w = cvt[w - 0x80];   /* Convert extended char to upper (SBCS) */
#else
            w = ff_convert(ff_wtoupper(w), 0);  /* Upper converted Unicode -> OEM code */
#endif
            cf |= NS_LFN;               /* Force create LFN entry */
        }

        if (_DF1S && w >= 0x100) {      /* Double byte char */
            if (i >= ni - 1) {
                cf |= NS_LOSS | NS_LFN; i = ni; continue;
            }
            dj->fn[i++] = (BYTE)(w >> 8);
        } else {                        /* Single byte char */
            if (!w || chk_chr("+,;[=]", w)) {       /* Replace illegal chars for SFN */
                w = '_'; cf |= NS_LOSS | NS_LFN;    /* Lossy conversion */
            } else {
                if (IsUpper(w)) {       /* ASCII large capital */
                    b |= 2;
                } else {
                    if (IsLower(w)) {   /* ASCII small capital */
                        b |= 1; w -= 0x20;
                    }
                }
            }
        }
        dj->fn[i++] = (BYTE)w;
    }

    if (dj->fn[0] == 0xE5) dj->fn[0] = 0x05;    /* If the first char collides with deleted mark, replace it with 0x05 */

    if (ni == 8) b <<= 2;
    if ((b & 0x0C) == 0x0C || (b & 0x03) == 0x03)   /* Create LFN entry when there are composite capitals */
        cf |= NS_LFN;
    if (!(cf & NS_LFN)) {                       /* When LFN is in 8.3 format without extended char, NT flags are created */
        if ((b & 0x03) == 0x01) cf |= NS_EXT;   /* NT flag (Extension has only small capital) */
        if ((b & 0x0C) == 0x04) cf |= NS_BODY;  /* NT flag (Filename has only small capital) */
    }

    dj->fn[NS] = cf;    /* SFN is created */

    return FR_OK;


#else   /* Non-LFN configuration */
    BYTE b, c, d, *sfn;
    int ni, si, i;
    const char *p;

    /* Create file name in directory form */
    sfn = dj->fn;
    mem_set(sfn, ' ', 11);
    si = i = b = 0; ni = 8;
    p = *path;
#if _FS_RPATH
    if (p[si] == '.') { /* Is this a dot entry? */
        for (;;) {
            c = p[si++];
            if (c != '.' || si >= 3) break;
            sfn[i++] = c;
        }
        if (c != '/' && c != '\\' && c > ' ') return FR_INVALID_NAME;
        *path = &p[si];                                 /* Rerurn pointer to the next segment */
        sfn[NS] = (c <= ' ') ? NS_LAST | NS_DOT : NS_DOT;   /* Set last segment flag if end of path */
        return FR_OK;
    }
#endif
    for (;;) {
        c = p[si++];
        if (c <= ' ' || c == '/' || c == '\\') break;   /* Break on end of segment */
        if (c == '.' || i >= ni) {
            if (ni != 8 || c != '.') return FR_INVALID_NAME;
            i = 8; ni = 11;
            b <<= 2; continue;
        }
        if (c >= 0x80) {                /* Extended char */
#ifdef _EXCVT
            c = cvt[c - 0x80];          /* Convert extend char (SBCS) */
#else
            b |= 3;                     /* Eliminate NT flag if ext char is exist */
#if !_DF1S  /* ASCII only cfg */
            return FR_INVALID_NAME;
#endif
#endif
        }
        if (IsDBCS1(c)) {               /* DBC 1st byte? */
            d = p[si++];                /* Get 2nd byte */
            if (!IsDBCS2(d) || i >= ni - 1) /* Reject invalid DBC */
                return FR_INVALID_NAME;
            sfn[i++] = c;
            sfn[i++] = d;
        } else {                        /* Single byte code */
            if (chk_chr(" \"*+,[=]|\x7F", c))   /* Reject illegal chrs for SFN */
                return FR_INVALID_NAME;
            if (IsUpper(c)) {           /* ASCII large capital? */
                b |= 2;
            } else {
                if (IsLower(c)) {       /* ASCII small capital? */
                    b |= 1; c -= 0x20;
                }
            }
            sfn[i++] = c;
        }
    }
    *path = &p[si];                     /* Rerurn pointer to the next segment */
    c = (c <= ' ') ? NS_LAST : 0;       /* Set last segment flag if end of path */

    if (!i) return FR_INVALID_NAME;     /* Reject null string */
    if (sfn[0] == 0xE5) sfn[0] = 0x05;  /* When first char collides with 0xE5, replace it with 0x05 */

    if (ni == 8) b <<= 2;
    if ((b & 0x03) == 0x01) c |= NS_EXT;    /* NT flag (Extension has only small capital) */
    if ((b & 0x0C) == 0x04) c |= NS_BODY;   /* NT flag (Filename has only small capital) */

    sfn[NS] = c;        /* Store NT flag, File name is created */

    return FR_OK;
#endif
}




/*-----------------------------------------------------------------------*/
/* Get file information from directory entry                             */
/*-----------------------------------------------------------------------*/
#if _FS_MINIMIZE <= 1
static
void get_fileinfo (     /* No return code */
    DIR *dj,            /* Pointer to the directory object */

    FILINFO *fno        /* Pointer to the file information to be filled */
)
{
    int i;
    BYTE c, nt, *dir;
    char *p;


    p = fno->fname;
    if (dj->sect) {
        dir = dj->dir;
        nt = dir[DIR_NTres];        /* NT flag */
        for (i = 0; i < 8; i++) {   /* Copy name body */
            c = dir[i];
            if (c == ' ') break;
            if (c == 0x05) c = 0xE5;
            if (_USE_LFN && (nt & NS_BODY) && IsUpper(c)) c += 0x20;
            *p++ = c;
        }
        if (dir[8] != ' ') {        /* Copy name extension */
            *p++ = '.';
            for (i = 8; i < 11; i++) {
                c = dir[i];
                if (c == ' ') break;
                if (_USE_LFN && (nt & NS_EXT) && IsUpper(c)) c += 0x20;
                *p++ = c;
            }
        }
        fno->fattrib = dir[DIR_Attr];               /* Attribute */
        fno->fsize = LD_DWORD(dir+DIR_FileSize);    /* Size */
        fno->fdate = LD_WORD(dir+DIR_WrtDate);      /* Date */
        fno->ftime = LD_WORD(dir+DIR_WrtTime);      /* Time */
    }
    *p = 0;

#if _USE_LFN
    if (fno->lfname) {
        XCHAR *tp = fno->lfname;
        WCHAR w, *lfn;

        i = 0;
        if (dj->sect && dj->lfn_idx != 0xFFFF) {/* Get LFN if available */
            lfn = dj->lfn;
            while ((w = *lfn++) != 0) {         /* Get an LFN char */
#if !_LFN_UNICODE
                w = ff_convert(w, 0);           /* Unicode -> OEM conversion */
                if (!w) { i = 0; break; }       /* Could not convert, no LFN */
                if (_DF1S && w >= 0x100)        /* Put 1st byte if it is a DBC */
                    tp[i++] = (XCHAR)(w >> 8);
#endif
                if (i >= fno->lfsize - 1) { i = 0; break; } /* Buffer overrun, no LFN */
                tp[i++] = (XCHAR)w;
            }
        }
        tp[i] = 0;  /* Terminator */
    }
#endif
}
#endif /* _FS_MINIMIZE <= 1 */




/*-----------------------------------------------------------------------*/
/* Follow a file path                                                    */
/*-----------------------------------------------------------------------*/

static
FRESULT follow_path (   /* FR_OK(0): successful, !=0: error code */
    DIR *dj,            /* Directory object to return last directory and found object */
    const XCHAR *path   /* Full-path string to find a file or directory */
)
{
    FRESULT res;
    BYTE *dir, last;


    while (!_USE_LFN && *path == ' ') path++;   /* Skip leading spaces */
#if _FS_RPATH
    if (*path == '/' || *path == '\\') { /* There is a heading separator */
        path++; dj->sclust = 0;     /* Strip it and start from the root dir */
    } else {                            /* No heading saparator */
        dj->sclust = dj->fs->cdir;  /* Start from the current dir */
    }
#else
    if (*path == '/' || *path == '\\')  /* Strip heading separator if exist */
        path++;
    dj->sclust = 0;                     /* Start from the root dir */
#endif

    if ((UINT)*path < ' ') {            /* Null path means the start directory itself */
        res = dir_seek(dj, 0);
        dj->dir = NULL;

    } else {                            /* Follow path */
        for (;;) {
            res = create_name(dj, &path);   /* Get a segment */
            if (res != FR_OK) break;
            res = dir_find(dj);             /* Find it */
            last = *(dj->fn+NS) & NS_LAST;
            if (res != FR_OK) {             /* Could not find the object */
                if (res == FR_NO_FILE && !last)
                    res = FR_NO_PATH;
                break;
            }
            if (last) break;                /* Last segment match. Function completed. */
            dir = dj->dir;                  /* There is next segment. Follow the sub directory */
            if (!(dir[DIR_Attr] & AM_DIR)) { /* Cannot follow because it is a file */
                res = FR_NO_PATH; break;
            }
            dj->sclust = ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);
        }
    }

    return res;
}




/*-----------------------------------------------------------------------*/
/* Load boot record and check if it is an FAT boot record                */
/*-----------------------------------------------------------------------*/

static
BYTE check_fs ( /* 0:The FAT boot record, 1:Valid boot record but not an FAT, 2:Not a boot record, 3:Error */
    FATFS *fs,  /* File system object */
    DWORD sect  /* Sector# (lba) to check if it is an FAT boot record or not */
)
{
    if (disk_read(fs->drive, fs->win, sect, 1) != RES_OK)   /* Load boot record */
        return 3;
    if (LD_WORD(&fs->win[BS_55AA]) != 0xAA55)       /* Check record signature (always placed at offset 510 even if the sector size is >512) */
        return 2;

    if ((LD_DWORD(&fs->win[BS_FilSysType]) & 0xFFFFFF) == 0x544146) /* Check "FAT" string */
        return 0;
    if ((LD_DWORD(&fs->win[BS_FilSysType32]) & 0xFFFFFF) == 0x544146)
        return 0;

    return 1;
}




/*-----------------------------------------------------------------------*/
/* Make sure that the file system is valid                               */
/*-----------------------------------------------------------------------*/


FRESULT chk_mounted (   /* FR_OK(0): successful, !=0: any error occured */
    const XCHAR **path, /* Pointer to pointer to the path name (drive number) */
    FATFS **rfs,        /* Pointer to pointer to the found file system object */
    BYTE chk_wp         /* !=0: Check media write protection for write access */
)
{
    BYTE fmt, *tbl;
    UINT vol;
    DSTATUS stat;
    DWORD bsect, fsize, tsect, mclst;
    const XCHAR *p = *path;
    FATFS *fs;

    /* Get logical drive number from the path name */
    vol = p[0] - '0';               /* Is there a drive number? */
    if (vol <= 9 && p[1] == ':') {  /* Found a drive number, get and strip it */
        p += 2; *path = p;          /* Return pointer to the path name */
    } else {                        /* No drive number is given */
#if _FS_RPATH
        vol = Drive;                /* Use current drive */
#else
        vol = 0;                    /* Use drive 0 */
#endif
    }

    /* Check if the logical drive is valid or not */
    if (vol >= _DRIVES)             /* Is the drive number valid? */
        return FR_INVALID_DRIVE;
    *rfs = fs = FatFs[vol];         /* Returen pointer to the corresponding file system object */
    if (!fs) return FR_NOT_ENABLED; /* Is the file system object available? */

    ENTER_FF(fs);                   /* Lock file system */

    if (fs->fs_type) {              /* If the logical drive has been mounted */
        stat = disk_status(fs->drive);
        if (!(stat & STA_NOINIT)) { /* and the physical drive is kept initialized (has not been changed), */
#if !_FS_READONLY
            if (chk_wp && (stat & STA_PROTECT)) /* Check write protection if needed */
                return FR_WRITE_PROTECTED;
#endif
            return FR_OK;           /* The file system object is valid */
        }
    }

    /* The logical drive must be mounted. Following code attempts to mount the volume */

    fs->fs_type = 0;                    /* Clear the file system object */
    fs->drive = (BYTE)LD2PD(vol);       /* Bind the logical drive and a physical drive */
    stat = disk_initialize(fs->drive);  /* Initialize low level disk I/O layer */
    if (stat & STA_NOINIT)              /* Check if the drive is ready */
        return FR_NOT_READY;
#if _MAX_SS != 512                      /* Get disk sector size if needed */
    if (disk_ioctl(fs->drive, GET_SECTOR_SIZE, &SS(fs)) != RES_OK || SS(fs) > _MAX_SS)
        return FR_NO_FILESYSTEM;
#endif
#if !_FS_READONLY
    if (chk_wp && (stat & STA_PROTECT)) /* Check disk write protection if needed */
        return FR_WRITE_PROTECTED;
#endif
    /* Search FAT partition on the drive */
    fmt = check_fs(fs, bsect = 0);      /* Check sector 0 as an SFD format */
    if (fmt == 1) {                     /* Not an FAT boot record, it may be patitioned */
        /* Check a partition listed in top of the partition table */
        tbl = &fs->win[MBR_Table + LD2PT(vol) * 16];    /* Partition table */
        if (tbl[4]) {                                   /* Is the partition existing? */
            bsect = LD_DWORD(&tbl[8]);                  /* Partition offset in LBA */
            fmt = check_fs(fs, bsect);                  /* Check the partition */
        }
    }
    if (fmt == 3) return FR_DISK_ERR;
    if (fmt || LD_WORD(fs->win+BPB_BytsPerSec) != SS(fs))   /* No valid FAT patition is found */
        return FR_NO_FILESYSTEM;

    /* Initialize the file system object */
    fsize = LD_WORD(fs->win+BPB_FATSz16);               /* Number of sectors per FAT */
    if (!fsize) fsize = LD_DWORD(fs->win+BPB_FATSz32);
    fs->sects_fat = fsize;
    fs->n_fats = fs->win[BPB_NumFATs];                  /* Number of FAT copies */
    fsize *= fs->n_fats;                                /* (Number of sectors in FAT area) */
    fs->fatbase = bsect + LD_WORD(fs->win+BPB_RsvdSecCnt); /* FAT start sector (lba) */
    fs->csize = fs->win[BPB_SecPerClus];                /* Number of sectors per cluster */
    fs->n_rootdir = LD_WORD(fs->win+BPB_RootEntCnt);    /* Nmuber of root directory entries */
    tsect = LD_WORD(fs->win+BPB_TotSec16);              /* Number of sectors on the volume */
    if (!tsect) tsect = LD_DWORD(fs->win+BPB_TotSec32);
    fs->max_clust = mclst = (tsect                      /* Last cluster# + 1 (Number of clusters + 2) */
        - LD_WORD(fs->win+BPB_RsvdSecCnt) - fsize - fs->n_rootdir / (SS(fs)/32)
        ) / fs->csize + 2;

    fmt = FS_FAT12;                                     /* Determine the FAT sub type */
    if (mclst >= 0xFF7) fmt = FS_FAT16;                 /* Number of clusters >= 0xFF5 */
    if (mclst >= 0xFFF7) fmt = FS_FAT32;                /* Number of clusters >= 0xFFF5 */

    if (fmt == FS_FAT32)
        fs->dirbase = LD_DWORD(fs->win+BPB_RootClus);   /* Root directory start cluster */
    else
        fs->dirbase = fs->fatbase + fsize;              /* Root directory start sector (lba) */
    fs->database = fs->fatbase + fsize + fs->n_rootdir / (SS(fs)/32);   /* Data start sector (lba) */

#if !_FS_READONLY
    /* Initialize allocation information */
    fs->free_clust = 0xFFFFFFFF;
    fs->wflag = 0;
    /* Get fsinfo if needed */
    if (fmt == FS_FAT32) {
        fs->fsi_flag = 0;
        fs->fsi_sector = bsect + LD_WORD(fs->win+BPB_FSInfo);
        if (disk_read(fs->drive, fs->win, fs->fsi_sector, 1) == RES_OK &&
            LD_WORD(fs->win+BS_55AA) == 0xAA55 &&
            LD_DWORD(fs->win+FSI_LeadSig) == 0x41615252 &&
            LD_DWORD(fs->win+FSI_StrucSig) == 0x61417272) {
            fs->last_clust = LD_DWORD(fs->win+FSI_Nxt_Free);
            fs->free_clust = LD_DWORD(fs->win+FSI_Free_Count);
        }
    }
#endif
    fs->fs_type = fmt;      /* FAT sub-type */
    fs->winsect = 0;        /* Invalidate sector cache */
#if _FS_RPATH
    fs->cdir = 0;           /* Current directory (root dir) */
#endif
    fs->id = ++Fsid;        /* File system mount ID */

    return FR_OK;
}




/*-----------------------------------------------------------------------*/
/* Check if the file/dir object is valid or not                          */
/*-----------------------------------------------------------------------*/

static
FRESULT validate (  /* FR_OK(0): The object is valid, !=0: Invalid */
    FATFS *fs,      /* Pointer to the file system object */
    WORD id         /* Member id of the target object to be checked */
)
{
    if (!fs || !fs->fs_type || fs->id != id)
        return FR_INVALID_OBJECT;

    ENTER_FF(fs);       /* Lock file system */

    if (disk_status(fs->drive) & STA_NOINIT)
        return FR_NOT_READY;

    return FR_OK;
}




/*--------------------------------------------------------------------------

   Public Functions

--------------------------------------------------------------------------*/



/*-----------------------------------------------------------------------*/
/* Mount/Unmount a Locical Drive                                         */
/*-----------------------------------------------------------------------*/

FRESULT f_mount (
    BYTE vol,       /* Logical drive number to be mounted/unmounted */
    FATFS *fs       /* Pointer to new file system object (NULL for unmount)*/
)
{
    FATFS *rfs;


    if (vol >= _DRIVES)             /* Check if the drive number is valid */
        return FR_INVALID_DRIVE;
    rfs = FatFs[vol];               /* Get current fs object */

    if (rfs) {
#if _FS_REENTRANT                   /* Discard sync object of the current volume */
        if (!ff_del_syncobj(rfs->sobj)) return FR_INT_ERR;
#endif
        rfs->fs_type = 0;           /* Clear old fs object */
    }

    if (fs) {
        fs->fs_type = 0;            /* Clear new fs object */
#if _FS_REENTRANT                   /* Create sync object for the new volume */
        if (!ff_cre_syncobj(vol, &fs->sobj)) return FR_INT_ERR;
#endif
    }
    FatFs[vol] = fs;                /* Register new fs object */

    return FR_OK;
}




/*-----------------------------------------------------------------------*/
/* Open or Create a File                                                 */
/*-----------------------------------------------------------------------*/

FRESULT f_open (
    FIL *fp,            /* Pointer to the blank file object */
    const XCHAR *path,  /* Pointer to the file name */
    BYTE mode           /* Access mode and file open mode flags */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);
    BYTE *dir;


    fp->fs = NULL;      /* Clear file object */
#if !_FS_READONLY
    mode &= (FA_READ | FA_WRITE | FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW);
    res = chk_mounted(&path, &dj.fs, (BYTE)(mode & (FA_WRITE | FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW)));
#else
    mode &= FA_READ;
    res = chk_mounted(&path, &dj.fs, 0);
#endif
    if (res != FR_OK) LEAVE_FF(dj.fs, res);
    INITBUF(dj, sfn, lfn);
    res = follow_path(&dj, path);   /* Follow the file path */

#if !_FS_READONLY
    /* Create or Open a file */
    if (mode & (FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW)) {
        DWORD ps, cl;

        if (res != FR_OK) {         /* No file, create new */
            if (res == FR_NO_FILE)  /* There is no file to open, create a new entry */
                res = dir_register(&dj);
            if (res != FR_OK) LEAVE_FF(dj.fs, res);
            mode |= FA_CREATE_ALWAYS;
            dir = dj.dir;           /* Created entry (SFN entry) */
        }
        else {                      /* Any object is already existing */
            if (mode & FA_CREATE_NEW)           /* Cannot create new */
                LEAVE_FF(dj.fs, FR_EXIST);
            dir = dj.dir;
            if (!dir || (dir[DIR_Attr] & (AM_RDO | AM_DIR)))    /* Cannot overwrite it (R/O or DIR) */
                LEAVE_FF(dj.fs, FR_DENIED);
            if (mode & FA_CREATE_ALWAYS) {      /* Resize it to zero on over write mode */
                cl = ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);    /* Get start cluster */
                ST_WORD(dir+DIR_FstClusHI, 0);  /* cluster = 0 */
                ST_WORD(dir+DIR_FstClusLO, 0);
                ST_DWORD(dir+DIR_FileSize, 0);  /* size = 0 */
                dj.fs->wflag = 1;
                ps = dj.fs->winsect;            /* Remove the cluster chain */
                if (cl) {
                    res = remove_chain(dj.fs, cl);
                    if (res) LEAVE_FF(dj.fs, res);
                    dj.fs->last_clust = cl - 1; /* Reuse the cluster hole */
                }
                res = move_window(dj.fs, ps);
                if (res != FR_OK) LEAVE_FF(dj.fs, res);
            }
        }
        if (mode & FA_CREATE_ALWAYS) {
            dir[DIR_Attr] = 0;                  /* Reset attribute */
            ps = get_fattime();
            ST_DWORD(dir+DIR_CrtTime, ps);      /* Created time */
            dj.fs->wflag = 1;
            mode |= FA__WRITTEN;                /* Set file changed flag */
        }
    }
    /* Open an existing file */
    else {
#endif /* !_FS_READONLY */
        if (res != FR_OK) LEAVE_FF(dj.fs, res); /* Follow failed */
        dir = dj.dir;
        if (!dir || (dir[DIR_Attr] & AM_DIR))   /* It is a directory */
            LEAVE_FF(dj.fs, FR_NO_FILE);
#if !_FS_READONLY
        if ((mode & FA_WRITE) && (dir[DIR_Attr] & AM_RDO)) /* R/O violation */
            LEAVE_FF(dj.fs, FR_DENIED);
    }
    fp->dir_sect = dj.fs->winsect;      /* Pointer to the directory entry */
    fp->dir_ptr = dj.dir;
#endif
    fp->flag = mode;                    /* File access mode */
    fp->org_clust =                     /* File start cluster */
        ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);
    fp->fsize = LD_DWORD(dir+DIR_FileSize); /* File size */
    fp->fptr = 0; fp->csect = 255;      /* File pointer */
    fp->dsect = 0;
    fp->fs = dj.fs; fp->id = dj.fs->id; /* Owner file system object of the file */

    LEAVE_FF(dj.fs, FR_OK);
}

/*-----------------------------------------------------------------------*/
/* Read File                                                             */
/*-----------------------------------------------------------------------*/


FRESULT f_read_direct(              //read up to 0x20 sectors
    FIL *fp,
    void *buff,
    UINT btr,
    UINT *br,
    Cluster* clusters
)
{
    DWORD clst, sect;
    UINT rcnt, cc;
    WORD i,j,cnt;
    WORD cluster_ptr = 0;
    INT bound_a;
    Cluster* a,*b;
    *br = 0;

    if(btr > (fp->fsize - fp->fptr))/*Make sure that last block will be aligned*/
    {
        /*Fallback to standard fread since chances are it WONT be aligned...and we're not interested in anything < 16KB anyway*/
        return f_read(fp,buff,btr,br);
    }

    for ( ;  btr;
         fp->fptr += rcnt, *br += rcnt, btr -= rcnt)
        {
            bound_a = (fp->fptr & (SS(fp->fs)-1));

            if ( bound_a == 0)
            {
                if (fp->csect >= fp->fs->csize)
                {
                    clst = (fp->fptr == 0) ? fp->org_clust : get_fat(fp->fs, fp->curr_clust);

                    if (clst <= 1){ABORT(fp->fs, FR_INT_ERR);}
                    else if (clst == 0xFFFFFFFF) { ABORT(fp->fs, FR_DISK_ERR); }

                    fp->curr_clust = clst;
                    fp->csect = 0;
                }

                sect = clust2sect(fp->fs, fp->curr_clust);

                if (!sect)
                    ABORT(fp->fs, FR_INT_ERR);

                sect += fp->csect;
                cc = btr / SS(fp->fs);

                if (cc)
                {
                    cc = (fp->csect + cc > fp->fs->csize) ? fp->fs->csize - fp->csect : cc;
                    clusters[cluster_ptr].base = sect;
                    clusters[cluster_ptr++].sectors = cc;
                    fp->csect += (BYTE)cc;
                    rcnt = SS(fp->fs) * cc;
                    continue;
                }
#if !_FS_TINY
#if !_FS_READONLY
                if (fp->flag & FA__DIRTY)
                {
                    if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                        ABORT(fp->fs, FR_DISK_ERR);

                    fp->flag &= ~FA__DIRTY;
                }
#endif
                if (fp->dsect != sect)
                {
                    if (disk_read(fp->fs->drive, fp->buf, sect, 1) != RES_OK)
                        ABORT(fp->fs, FR_DISK_ERR);
                }
#endif
                fp->dsect = sect;
                fp->csect++;
            }
            rcnt = SS(fp->fs) - bound_a;
            if (rcnt > btr) rcnt = btr;
    }

    i = 0;

    while(i<cluster_ptr)    //Hackish code on porpuse :P
    {
        cnt = 0;

        if(i >= (cluster_ptr-1))
            goto ___skip;

        {
            j = i;
            a = &clusters[j + 0];
            b = &clusters[j + 1];

            if(b->base < a->base)
                goto ___skip;
            if( ((b->base - a->base) != a->sectors ) )
                goto ___skip;

            cnt += a->sectors;
            cnt += b->sectors;

            j += 2;

            while(j < cluster_ptr)
            {
                a = &clusters[j];

                if(a->base < b->base)
                    goto ___skip2;  //just fill the pending sectors
                if( (a->base - b->base) != a->sectors )
                    goto ___skip2;  //just fill the pending sectors

                cnt += a->sectors;
                b = a;
                ++j;
            }
        }

        if(!cnt)
        {
            ___skip:
            if (disk_read_multi(fp->fs->drive,buff,clusters[i].base,clusters[i].sectors) != RES_OK)
                ABORT(fp->fs, FR_DISK_ERR);

            ++i;
            continue;
        }

        ___skip2:
        {
            if (disk_read_multi(fp->fs->drive,buff,clusters[i].base,cnt) != RES_OK)
                ABORT(fp->fs, FR_DISK_ERR);

            i = j;
        }
    }

    LEAVE_FF(fp->fs, FR_OK);
}

#if 0
FRESULT f_read (
    FIL *fp,        /* Pointer to the file object */
    void *buff,     /* Pointer to data buffer */
    UINT btr,       /* Number of bytes to read */
    UINT *br        /* Pointer to number of bytes read */
)
{
    FRESULT res;
    DWORD clst, sect, remain;
    UINT rcnt, cc;
    BYTE *rbuff = buff;


    *br = 0;    /* Initialize bytes read */

    res = validate(fp->fs, fp->id);                 /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)                       /* Check abort flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (!(fp->flag & FA_READ))                      /* Check access mode */
        LEAVE_FF(fp->fs, FR_DENIED);
    remain = fp->fsize - fp->fptr;
    if (btr > remain) btr = (UINT)remain;           /* Truncate btr by remaining bytes */

    for ( ;  btr;                                   /* Repeat until all data transferred */
        rbuff += rcnt, fp->fptr += rcnt, *br += rcnt, btr -= rcnt) {
        if ((fp->fptr & (SS(fp->fs)-1)) == 0) {         /* On the sector boundary? */
            if (fp->csect >= fp->fs->csize) {       /* On the cluster boundary? */
                clst = (fp->fptr == 0) ?            /* On the top of the file? */
                    fp->org_clust : get_fat(fp->fs, fp->curr_clust);
                if (clst <= 1) ABORT(fp->fs, FR_INT_ERR);
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                fp->curr_clust = clst;              /* Update current cluster */
                fp->csect = 0;                      /* Reset sector offset in the cluster */
            }
            sect = clust2sect(fp->fs, fp->curr_clust);  /* Get current sector */
            if (!sect) ABORT(fp->fs, FR_INT_ERR);
            sect += fp->csect;
            cc = btr / SS(fp->fs);                  /* When remaining bytes >= sector size, */
            if (cc) {                               /* Read maximum contiguous sectors directly */
                if (fp->csect + cc > fp->fs->csize) /* Clip at cluster boundary */
                    cc = fp->fs->csize - fp->csect;
                if (disk_read(fp->fs->drive, rbuff, sect, (BYTE)cc) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
#if !_FS_READONLY && _FS_MINIMIZE <= 2
#if _FS_TINY
                if (fp->fs->wflag && fp->fs->winsect - sect < cc)       /* Replace one of the read sectors with cached data if it contains a dirty sector */
                    mem_cpy(rbuff + ((fp->fs->winsect - sect) * SS(fp->fs)), fp->fs->win, SS(fp->fs));
#else
                if ((fp->flag & FA__DIRTY) && fp->dsect - sect < cc)    /* Replace one of the read sectors with cached data if it contains a dirty sector */
                    mem_cpy(rbuff + ((fp->dsect - sect) * SS(fp->fs)), fp->buf, SS(fp->fs));
#endif
#endif
                fp->csect += (BYTE)cc;              /* Next sector address in the cluster */
                rcnt = SS(fp->fs) * cc;             /* Number of bytes transferred */
                continue;
            }
#if !_FS_TINY
#if !_FS_READONLY
            if (fp->flag & FA__DIRTY) {         /* Write sector I/O buffer if needed */
                if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
                fp->flag &= ~FA__DIRTY;
            }
#endif
            if (fp->dsect != sect) {            /* Fill sector buffer with file data */
                if (disk_read(fp->fs->drive, fp->buf, sect, 1) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
            }
#endif
            fp->dsect = sect;
            fp->csect++;                            /* Next sector address in the cluster */
        }
        rcnt = SS(fp->fs) - (fp->fptr & (SS(fp->fs)-1));    /* Get partial sector data from sector buffer */
        if (rcnt > btr) rcnt = btr;
#if _FS_TINY
        if (move_window(fp->fs, fp->dsect))         /* Move sector window */
            ABORT(fp->fs, FR_DISK_ERR);
        mem_cpy(rbuff, &fp->fs->win[fp->fptr % SS(fp->fs)], rcnt);  /* Pick partial sector */
#else
        mem_cpy(rbuff, &fp->buf[fp->fptr % SS(fp->fs)], rcnt);  /* Pick partial sector */
#endif
    }

    LEAVE_FF(fp->fs, FR_OK);
}
#else
FRESULT f_read (
    FIL *fp,        /* Pointer to the file object */
    void *buff,     /* Pointer to data buffer */
    UINT btr,       /* Number of bytes to read */
    UINT *br        /* Pointer to number of bytes read */
)
{
    FRESULT res;
    DWORD clst, sect, remain;
    UINT rcnt, cc;
    BYTE *rbuff = buff;
    BYTE* sbuff = rbuff;
    DWORD sector_base = 0;
    DWORD sector_run = 0;
    DWORD prev_cluster = 0;

    *br = 0;    /* Initialize bytes read */

    res = validate(fp->fs, fp->id);                 /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)                       /* Check abort flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (!(fp->flag & FA_READ))                      /* Check access mode */
        LEAVE_FF(fp->fs, FR_DENIED);
    remain = fp->fsize - fp->fptr;
    if (btr > remain) btr = (UINT)remain;           /* Truncate btr by remaining bytes */

    for ( ;  btr;                                   /* Repeat until all data transferred */
        rbuff += rcnt, fp->fptr += rcnt, *br += rcnt, btr -= rcnt) {
        if ((fp->fptr & (SS(fp->fs)-1)) == 0) {         /* On the sector boundary? */
            if (fp->csect >= fp->fs->csize) {       /* On the cluster boundary? */
                clst = (fp->fptr == 0) ?            /* On the top of the file? */
                    fp->org_clust : get_fat(fp->fs, fp->curr_clust);
                if (clst <= 1) ABORT(fp->fs, FR_INT_ERR);
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                fp->curr_clust = clst;              /* Update current cluster */
                fp->csect = 0;                      /* Reset sector offset in the cluster */
            }
            sect = clust2sect(fp->fs, fp->curr_clust);  /* Get current sector */
            if (!sect) ABORT(fp->fs, FR_INT_ERR);
            sect += fp->csect;
            cc = btr / SS(fp->fs);                  /* When remaining bytes >= sector size, */
            if (cc) {                               /* Read maximum contiguous sectors directly */
                if (fp->csect + cc > fp->fs->csize) /* Clip at cluster boundary */
                {
                    cc = fp->fs->csize - fp->csect;
                }

                if((prev_cluster + 1) != fp->curr_clust)
                {
                    if(sector_run)
                    {
                        if (disk_read_multi(fp->fs->drive, sbuff,sector_base,sector_run) != RES_OK)
                        {
                            ABORT(fp->fs, FR_DISK_ERR);
                        }
                        sector_run = 0;
                    }

                    if (disk_read_multi(fp->fs->drive, rbuff, sect, cc) != RES_OK)
                    {
                        ABORT(fp->fs, FR_DISK_ERR);
                    }
                }
                else
                {
                    if(0 == sector_run)
                    {
                        sbuff = rbuff;
                        sector_base = sect;
                    }
                    sector_run += (DWORD)cc;
                }

#if !_FS_READONLY && _FS_MINIMIZE <= 2
#if _FS_TINY
                if (fp->fs->wflag && fp->fs->winsect - sect < cc)       /* Replace one of the read sectors with cached data if it contains a dirty sector */
                    mem_cpy(rbuff + ((fp->fs->winsect - sect) * SS(fp->fs)), fp->fs->win, SS(fp->fs));
#else
                if ((fp->flag & FA__DIRTY) && fp->dsect - sect < cc)    /* Replace one of the read sectors with cached data if it contains a dirty sector */
                    mem_cpy(rbuff + ((fp->dsect - sect) * SS(fp->fs)), fp->buf, SS(fp->fs));
#endif
#endif
                fp->csect += (BYTE)cc;              /* Next sector address in the cluster */
                rcnt = cc << 9;                     /* Number of bytes transferred */
                prev_cluster = fp->curr_clust;
                continue;
            }
            prev_cluster = fp->curr_clust;
#if !_FS_TINY
#if !_FS_READONLY
            if (fp->flag & FA__DIRTY) {         /* Write sector I/O buffer if needed */
                if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
                fp->flag &= ~FA__DIRTY;
            }
#endif
            if (fp->dsect != sect) {            /* Fill sector buffer with file data */
                if (disk_read(fp->fs->drive, fp->buf, sect, 1) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
            }
#endif
            fp->dsect = sect;
            fp->csect++;                            /* Next sector address in the cluster */
        }
        rcnt = SS(fp->fs) - (fp->fptr & (SS(fp->fs)-1));    /* Get partial sector data from sector buffer */
        if (rcnt > btr) rcnt = btr;
#if _FS_TINY
        if (move_window(fp->fs, fp->dsect))         /* Move sector window */
            ABORT(fp->fs, FR_DISK_ERR);
        mem_cpy(rbuff, &fp->fs->win[fp->fptr % SS(fp->fs)], rcnt);  /* Pick partial sector */
#else
        if (rbuff < (BYTE *)0x00FF0000)
            neo_copyto_myth_psram(&fp->buf[fp->fptr % SS(fp->fs)], (int)rbuff, rcnt); /* ram to myth psram */
        else
            mem_cpy(rbuff, &fp->buf[fp->fptr % SS(fp->fs)], rcnt);  /* Pick partial sector */
#endif
    }

    if(sector_run)
    {
        if (disk_read_multi(fp->fs->drive, sbuff,sector_base,sector_run) != RES_OK)
        {
            ABORT(fp->fs, FR_DISK_ERR);
        }

    }

    LEAVE_FF(fp->fs, FR_OK);
}
#endif



#if !_FS_READONLY
/*-----------------------------------------------------------------------*/
/* Write File                                                            */
/*-----------------------------------------------------------------------*/

FRESULT f_write (
    FIL *fp,            /* Pointer to the file object */
    const void *buff,   /* Pointer to the data to be written */
    UINT btw,           /* Number of bytes to write */
    UINT *bw            /* Pointer to number of bytes written */
)
{
    FRESULT res;
    DWORD clst, sect;
    UINT wcnt, cc;
    const BYTE *wbuff = buff;


    *bw = 0;    /* Initialize bytes written */

    res = validate(fp->fs, fp->id);                 /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)                       /* Check abort flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (!(fp->flag & FA_WRITE))                     /* Check access mode */
        LEAVE_FF(fp->fs, FR_DENIED);
    if (fp->fsize + btw < fp->fsize) btw = 0;       /* File size cannot reach 4GB */

    for ( ;  btw;                                   /* Repeat until all data transferred */
        wbuff += wcnt, fp->fptr += wcnt, *bw += wcnt, btw -= wcnt) {
        if ((fp->fptr % SS(fp->fs)) == 0) {         /* On the sector boundary? */
            if (fp->csect >= fp->fs->csize) {       /* On the cluster boundary? */
                if (fp->fptr == 0) {                /* On the top of the file? */
                    clst = fp->org_clust;           /* Follow from the origin */
                    if (clst == 0)                  /* When there is no cluster chain, */
                        fp->org_clust = clst = create_chain(fp->fs, 0); /* Create a new cluster chain */
                } else {                            /* Middle or end of the file */
                    clst = create_chain(fp->fs, fp->curr_clust);            /* Follow or streach cluster chain */
                }
                if (clst == 0) break;               /* Could not allocate a new cluster (disk full) */
                if (clst == 1) ABORT(fp->fs, FR_INT_ERR);
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                fp->curr_clust = clst;              /* Update current cluster */
                fp->csect = 0;                      /* Reset sector address in the cluster */
            }
#if _FS_TINY
            if (fp->fs->winsect == fp->dsect && move_window(fp->fs, 0)) /* Write back data buffer prior to following direct transfer */
                ABORT(fp->fs, FR_DISK_ERR);
#else
            if (fp->flag & FA__DIRTY) {     /* Write back data buffer prior to following direct transfer */
                if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
                fp->flag &= ~FA__DIRTY;
            }
#endif
            sect = clust2sect(fp->fs, fp->curr_clust);  /* Get current sector */
            if (!sect) ABORT(fp->fs, FR_INT_ERR);
            sect += fp->csect;
            cc = btw / SS(fp->fs);                  /* When remaining bytes >= sector size, */
            if (cc) {                               /* Write maximum contiguous sectors directly */
                if (fp->csect + cc > fp->fs->csize) /* Clip at cluster boundary */
                    cc = fp->fs->csize - fp->csect;
                if (disk_write(fp->fs->drive, wbuff, sect, (BYTE)cc) != RES_OK)
                    ABORT(fp->fs, FR_DISK_ERR);
#if _FS_TINY
                if (fp->fs->winsect - sect < cc) {  /* Refill sector cache if it gets dirty by the direct write */
                    mem_cpy(fp->fs->win, wbuff + ((fp->fs->winsect - sect) * SS(fp->fs)), SS(fp->fs));
                    fp->fs->wflag = 0;
                }
#else
                if (fp->dsect - sect < cc) {        /* Refill sector cache if it gets dirty by the direct write */
                    mem_cpy(fp->buf, wbuff + ((fp->dsect - sect) * SS(fp->fs)), SS(fp->fs));
                    fp->flag &= ~FA__DIRTY;
                }
#endif
                fp->csect += (BYTE)cc;              /* Next sector address in the cluster */
                wcnt = SS(fp->fs) * cc;             /* Number of bytes transferred */
                continue;
            }
#if _FS_TINY
            if (fp->fptr >= fp->fsize) {            /* Avoid silly buffer filling at growing edge */
                if (move_window(fp->fs, 0)) ABORT(fp->fs, FR_DISK_ERR);
                fp->fs->winsect = sect;
            }
#else
            if (fp->dsect != sect) {                /* Fill sector buffer with file data */
                if (fp->fptr < fp->fsize &&
                    disk_read(fp->fs->drive, fp->buf, sect, 1) != RES_OK)
                        ABORT(fp->fs, FR_DISK_ERR);
            }
#endif
            fp->dsect = sect;
            fp->csect++;                            /* Next sector address in the cluster */
        }
        wcnt = SS(fp->fs) - (fp->fptr % SS(fp->fs));    /* Put partial sector into file I/O buffer */
        if (wcnt > btw) wcnt = btw;
#if _FS_TINY
        if (move_window(fp->fs, fp->dsect))         /* Move sector window */
            ABORT(fp->fs, FR_DISK_ERR);
        mem_cpy(&fp->fs->win[fp->fptr % SS(fp->fs)], wbuff, wcnt);  /* Fit partial sector */
        fp->fs->wflag = 1;
#else
        mem_cpy(&fp->buf[fp->fptr % SS(fp->fs)], wbuff, wcnt);  /* Fit partial sector */
        fp->flag |= FA__DIRTY;
#endif
    }

    if (fp->fptr > fp->fsize) fp->fsize = fp->fptr; /* Update file size if needed */
    fp->flag |= FA__WRITTEN;                        /* Set file changed flag */

    LEAVE_FF(fp->fs, FR_OK);
}




/*-----------------------------------------------------------------------*/
/* Synchronize the File Object                                           */
/*-----------------------------------------------------------------------*/

FRESULT f_sync (
    FIL *fp     /* Pointer to the file object */
)
{
    FRESULT res;
    DWORD tim;
    BYTE *dir;


    res = validate(fp->fs, fp->id);     /* Check validity of the object */
    if (res == FR_OK) {
        if (fp->flag & FA__WRITTEN) {   /* Has the file been written? */
#if !_FS_TINY   /* Write-back dirty buffer */
            if (fp->flag & FA__DIRTY) {
                if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                    LEAVE_FF(fp->fs, FR_DISK_ERR);
                fp->flag &= ~FA__DIRTY;
            }
#endif
            /* Update the directory entry */
            res = move_window(fp->fs, fp->dir_sect);
            if (res == FR_OK) {
                dir = fp->dir_ptr;
                dir[DIR_Attr] |= AM_ARC;                    /* Set archive bit */
                ST_DWORD(dir+DIR_FileSize, fp->fsize);      /* Update file size */
                ST_WORD(dir+DIR_FstClusLO, fp->org_clust);  /* Update start cluster */
                ST_WORD(dir+DIR_FstClusHI, fp->org_clust >> 16);
                tim = get_fattime();            /* Updated time */
                ST_DWORD(dir+DIR_WrtTime, tim);
                fp->flag &= ~FA__WRITTEN;
                fp->fs->wflag = 1;
                res = sync(fp->fs);
            }
        }
    }

    LEAVE_FF(fp->fs, res);
}

#endif /* !_FS_READONLY */




/*-----------------------------------------------------------------------*/
/* Close File                                                            */
/*-----------------------------------------------------------------------*/

FRESULT f_close (
    FIL *fp     /* Pointer to the file object to be closed */
)
{
    FRESULT res;


#if _FS_READONLY
    res = validate(fp->fs, fp->id);
    if (res == FR_OK) fp->fs = NULL;
    LEAVE_FF(fp->fs, res);
#else
    res = f_sync(fp);
    if (res == FR_OK) fp->fs = NULL;
    return res;
#endif
}




/*-----------------------------------------------------------------------*/
/* Change Current Drive/Directory                                        */
/*-----------------------------------------------------------------------*/

#if _FS_RPATH

FRESULT f_chdrive (
    BYTE drv        /* Drive number */
)
{
    if (drv >= _DRIVES) return FR_INVALID_DRIVE;

    Drive = drv;

    return FR_OK;
}




FRESULT f_chdir (
    const XCHAR *path   /* Pointer to the directory path */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);
    BYTE *dir;


    res = chk_mounted(&path, &dj.fs, 0);
    if (res == FR_OK) {
        INITBUF(dj, sfn, lfn);
        res = follow_path(&dj, path);       /* Follow the file path */
        if (res == FR_OK) {                 /* Follow completed */
            dir = dj.dir;                   /* Pointer to the entry */
            if (!dir) {
                dj.fs->cdir = 0;            /* No entry (root dir) */
            } else {
                if (dir[DIR_Attr] & AM_DIR) /* Reached to the dir */
                    dj.fs->cdir = ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);
                else
                    res = FR_NO_PATH;       /* Could not reach the dir (it is a file) */
            }
        }
        if (res == FR_NO_FILE) res = FR_NO_PATH;
    }

    LEAVE_FF(dj.fs, res);
}

#endif



#if _FS_MINIMIZE <= 2
/*-----------------------------------------------------------------------*/
/* Seek File R/W Pointer                                                 */
/*-----------------------------------------------------------------------*/

FRESULT f_lseek (
    FIL *fp,        /* Pointer to the file object */
    DWORD ofs       /* File pointer from top of file */
)
{
    FRESULT res;
    DWORD clst, bcs, nsect, ifptr;


    res = validate(fp->fs, fp->id);     /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)           /* Check abort flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (ofs > fp->fsize                 /* In read-only mode, clip offset with the file size */
#if !_FS_READONLY
         && !(fp->flag & FA_WRITE)
#endif
        ) ofs = fp->fsize;

    ifptr = fp->fptr;
    fp->fptr = nsect = 0; fp->csect = 255;
    if (ofs > 0) {
        bcs = (DWORD)fp->fs->csize * SS(fp->fs);    /* Cluster size (byte) */
        if (ifptr > 0 &&
            (ofs - 1) / bcs >= (ifptr - 1) / bcs) { /* When seek to same or following cluster, */
            fp->fptr = (ifptr - 1) & ~(bcs - 1);    /* start from the current cluster */
            ofs -= fp->fptr;
            clst = fp->curr_clust;
        } else {                                    /* When seek to back cluster, */
            clst = fp->org_clust;                   /* start from the first cluster */
#if !_FS_READONLY
            if (clst == 0) {                        /* If no cluster chain, create a new chain */
                clst = create_chain(fp->fs, 0);
                if (clst == 1) ABORT(fp->fs, FR_INT_ERR);
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                fp->org_clust = clst;
            }
#endif
            fp->curr_clust = clst;
        }
        if (clst != 0) {
            while (ofs > bcs) {                     /* Cluster following loop */
#if !_FS_READONLY
                if (fp->flag & FA_WRITE) {          /* Check if in write mode or not */
                    clst = create_chain(fp->fs, clst);  /* Force streached if in write mode */
                    if (clst == 0) {                /* When disk gets full, clip file size */
                        ofs = bcs; break;
                    }
                } else
#endif
                    clst = get_fat(fp->fs, clst);   /* Follow cluster chain if not in write mode */
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                if (clst <= 1 || clst >= fp->fs->max_clust) ABORT(fp->fs, FR_INT_ERR);
                fp->curr_clust = clst;
                fp->fptr += bcs;
                ofs -= bcs;
            }
            fp->fptr += ofs;
            fp->csect = (BYTE)(ofs / SS(fp->fs));   /* Sector offset in the cluster */
            if (ofs % SS(fp->fs)) {
                nsect = clust2sect(fp->fs, clst);   /* Current sector */
                if (!nsect) ABORT(fp->fs, FR_INT_ERR);
                nsect += fp->csect;
                fp->csect++;
            }
        }
    }
    if (fp->fptr % SS(fp->fs) && nsect != fp->dsect) {
#if !_FS_TINY
#if !_FS_READONLY
        if (fp->flag & FA__DIRTY) {         /* Write-back dirty buffer if needed */
            if (disk_write(fp->fs->drive, fp->buf, fp->dsect, 1) != RES_OK)
                ABORT(fp->fs, FR_DISK_ERR);
            fp->flag &= ~FA__DIRTY;
        }
#endif
        if (disk_read(fp->fs->drive, fp->buf, nsect, 1) != RES_OK)
            ABORT(fp->fs, FR_DISK_ERR);
#endif
        fp->dsect = nsect;
    }
#if !_FS_READONLY
    if (fp->fptr > fp->fsize) {         /* Set changed flag if the file size is extended */
        fp->fsize = fp->fptr;
        fp->flag |= FA__WRITTEN;
    }
#endif

    LEAVE_FF(fp->fs, res);
}




#if _FS_MINIMIZE <= 1
/*-----------------------------------------------------------------------*/
/* Create a Directroy Object                                             */
/*-----------------------------------------------------------------------*/

FRESULT f_opendir (
    DIR *dj,            /* Pointer to directory object to create */
    const XCHAR *path   /* Pointer to the directory path */
)
{
    FRESULT res;
    NAMEBUF(sfn, lfn);
    BYTE *dir;


    res = chk_mounted(&path, &dj->fs, 0);
    if (res == FR_OK) {
        INITBUF((*dj), sfn, lfn);
        res = follow_path(dj, path);            /* Follow the path to the directory */
        if (res == FR_OK) {                     /* Follow completed */
            dir = dj->dir;
            if (dir) {                          /* It is not the root dir */
                if (dir[DIR_Attr] & AM_DIR) {   /* The object is a directory */
                    dj->sclust = ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);
                } else {                        /* The object is not a directory */
                    res = FR_NO_PATH;
                }
            }
            if (res == FR_OK) {
                dj->id = dj->fs->id;
                res = dir_seek(dj, 0);          /* Rewind dir */
            }
        }
        if (res == FR_NO_FILE) res = FR_NO_PATH;
    }

    LEAVE_FF(dj->fs, res);
}




/*-----------------------------------------------------------------------*/
/* Read Directory Entry in Sequense                                      */
/*-----------------------------------------------------------------------*/

FRESULT f_readdir (
    DIR *dj,            /* Pointer to the open directory object */
    FILINFO *fno        /* Pointer to file information to return */
)
{
    FRESULT res;
    NAMEBUF(sfn, lfn);


    res = validate(dj->fs, dj->id);         /* Check validity of the object */
    if (res == FR_OK) {
        INITBUF((*dj), sfn, lfn);
        if (!fno) {
            res = dir_seek(dj, 0);
        } else {
            res = dir_read(dj);
            if (res == FR_NO_FILE) {
                dj->sect = 0;
                res = FR_OK;
            }
            if (res == FR_OK) {             /* A valid entry is found */
                get_fileinfo(dj, fno);      /* Get the object information */
                res = dir_next(dj, FALSE);  /* Increment index for next */
                if (res == FR_NO_FILE) {
                    dj->sect = 0;
                    res = FR_OK;
                }
            }
        }
    }

    LEAVE_FF(dj->fs, res);
}



#if _FS_MINIMIZE == 0
/*-----------------------------------------------------------------------*/
/* Get File Status                                                       */
/*-----------------------------------------------------------------------*/

FRESULT f_stat (
    const XCHAR *path,  /* Pointer to the file path */
    FILINFO *fno        /* Pointer to file information to return */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);


    res = chk_mounted(&path, &dj.fs, 0);
    if (res == FR_OK) {
        INITBUF(dj, sfn, lfn);
        res = follow_path(&dj, path);   /* Follow the file path */
        if (res == FR_OK) {             /* Follwo completed */
            if (dj.dir) /* Found an object */
                get_fileinfo(&dj, fno);
            else        /* It is root dir */
                res = FR_INVALID_NAME;
        }
    }

    LEAVE_FF(dj.fs, res);
}



#if !_FS_READONLY
/*-----------------------------------------------------------------------*/
/* Get Number of Free Clusters                                           */
/*-----------------------------------------------------------------------*/

FRESULT f_getfree (
    const XCHAR *path,  /* Pointer to the logical drive number (root dir) */
    DWORD *nclst,       /* Pointer to the variable to return number of free clusters */
    FATFS **fatfs       /* Pointer to pointer to corresponding file system object to return */
)
{
    FRESULT res;
    DWORD n, clst, sect, stat;
    UINT i;
    BYTE fat, *p;


    /* Get drive number */
    res = chk_mounted(&path, fatfs, 0);
    if (res != FR_OK) LEAVE_FF(*fatfs, res);

    /* If number of free cluster is valid, return it without cluster scan. */
    if ((*fatfs)->free_clust <= (*fatfs)->max_clust - 2) {
        *nclst = (*fatfs)->free_clust;
        LEAVE_FF(*fatfs, FR_OK);
    }

    /* Get number of free clusters */
    fat = (*fatfs)->fs_type;
    n = 0;
    if (fat == FS_FAT12) {
        clst = 2;
        do {
            stat = get_fat(*fatfs, clst);
            if (stat == 0xFFFFFFFF) LEAVE_FF(*fatfs, FR_DISK_ERR);
            if (stat == 1) LEAVE_FF(*fatfs, FR_INT_ERR);
            if (stat == 0) n++;
        } while (++clst < (*fatfs)->max_clust);
    } else {
        clst = (*fatfs)->max_clust;
        sect = (*fatfs)->fatbase;
        i = 0; p = 0;
        do {
            if (!i) {
                res = move_window(*fatfs, sect++);
                if (res != FR_OK)
                    LEAVE_FF(*fatfs, res);
                p = (*fatfs)->win;
                i = SS(*fatfs);
            }
            if (fat == FS_FAT16) {
                if (LD_WORD(p) == 0) n++;
                p += 2; i -= 2;
            } else {
                if ((LD_DWORD(p) & 0x0FFFFFFF) == 0) n++;
                p += 4; i -= 4;
            }
        } while (--clst);
    }
    (*fatfs)->free_clust = n;
    if (fat == FS_FAT32) (*fatfs)->fsi_flag = 1;
    *nclst = n;

    LEAVE_FF(*fatfs, FR_OK);
}




/*-----------------------------------------------------------------------*/
/* Truncate File                                                         */
/*-----------------------------------------------------------------------*/

FRESULT f_truncate (
    FIL *fp     /* Pointer to the file object */
)
{
    FRESULT res;
    DWORD ncl;


    res = validate(fp->fs, fp->id);     /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)           /* Check abort flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (!(fp->flag & FA_WRITE))         /* Check access mode */
        LEAVE_FF(fp->fs, FR_DENIED);

    if (fp->fsize > fp->fptr) {
        fp->fsize = fp->fptr;   /* Set file size to current R/W point */
        fp->flag |= FA__WRITTEN;
        if (fp->fptr == 0) {    /* When set file size to zero, remove entire cluster chain */
            res = remove_chain(fp->fs, fp->org_clust);
            fp->org_clust = 0;
        } else {                /* When truncate a part of the file, remove remaining clusters */
            ncl = get_fat(fp->fs, fp->curr_clust);
            res = FR_OK;
            if (ncl == 0xFFFFFFFF) res = FR_DISK_ERR;
            if (ncl == 1) res = FR_INT_ERR;
            if (res == FR_OK && ncl < fp->fs->max_clust) {
                res = put_fat(fp->fs, fp->curr_clust, 0x0FFFFFFF);
                if (res == FR_OK) res = remove_chain(fp->fs, ncl);
            }
        }
    }
    if (res != FR_OK) fp->flag |= FA__ERROR;

    LEAVE_FF(fp->fs, res);
}




/*-----------------------------------------------------------------------*/
/* Delete a File or Directory                                            */
/*-----------------------------------------------------------------------*/

FRESULT f_unlink (
    const XCHAR *path       /* Pointer to the file or directory path */
)
{
    FRESULT res;
    DIR dj, sdj;
    NAMEBUF(sfn, lfn);
    BYTE *dir;
    DWORD dclst;


    res = chk_mounted(&path, &dj.fs, 1);
    if (res != FR_OK) LEAVE_FF(dj.fs, res);

    INITBUF(dj, sfn, lfn);
    res = follow_path(&dj, path);           /* Follow the file path */
    if (_FS_RPATH && res == FR_OK && (dj.fn[NS] & NS_DOT))
        res = FR_INVALID_NAME;
    if (res != FR_OK) LEAVE_FF(dj.fs, res); /* Follow failed */

    dir = dj.dir;
    if (!dir)                               /* Is it the root directory? */
        LEAVE_FF(dj.fs, FR_INVALID_NAME);
    if (dir[DIR_Attr] & AM_RDO)             /* Is it a R/O object? */
        LEAVE_FF(dj.fs, FR_DENIED);
    dclst = ((DWORD)LD_WORD(dir+DIR_FstClusHI) << 16) | LD_WORD(dir+DIR_FstClusLO);

    if (dir[DIR_Attr] & AM_DIR) {           /* It is a sub-directory */
        if (dclst < 2) LEAVE_FF(dj.fs, FR_INT_ERR);
        mem_cpy(&sdj, &dj, sizeof(DIR));    /* Check if the sub-dir is empty or not */
        sdj.sclust = dclst;
        res = dir_seek(&sdj, 2);
        if (res != FR_OK) LEAVE_FF(dj.fs, res);
        res = dir_read(&sdj);
        if (res == FR_OK) res = FR_DENIED;  /* Not empty sub-dir */
        if (res != FR_NO_FILE) LEAVE_FF(dj.fs, res);
    }

    res = dir_remove(&dj);                  /* Remove directory entry */
    if (res == FR_OK) {
        if (dclst)
            res = remove_chain(dj.fs, dclst);   /* Remove the cluster chain */
        if (res == FR_OK) res = sync(dj.fs);
    }

    LEAVE_FF(dj.fs, res);
}




/*-----------------------------------------------------------------------*/
/* Create a Directory                                                    */
/*-----------------------------------------------------------------------*/

FRESULT f_mkdir (
    const XCHAR *path       /* Pointer to the directory path */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);
    BYTE *dir, n;
    DWORD dsect, dclst, pclst, tim;


    res = chk_mounted(&path, &dj.fs, 1);
    if (res != FR_OK) LEAVE_FF(dj.fs, res);

    INITBUF(dj, sfn, lfn);
    res = follow_path(&dj, path);           /* Follow the file path */
    if (res == FR_OK) res = FR_EXIST;       /* Any file or directory is already existing */
    if (_FS_RPATH && res == FR_NO_FILE && (dj.fn[NS] & NS_DOT))
        res = FR_INVALID_NAME;
    if (res != FR_NO_FILE)                  /* Any error occured */
        LEAVE_FF(dj.fs, res);

    dclst = create_chain(dj.fs, 0);         /* Allocate a new cluster for new directory table */
    res = FR_OK;
    if (dclst == 0) res = FR_DENIED;
    if (dclst == 1) res = FR_INT_ERR;
    if (dclst == 0xFFFFFFFF) res = FR_DISK_ERR;
    if (res == FR_OK)
        res = move_window(dj.fs, 0);
    if (res != FR_OK) LEAVE_FF(dj.fs, res);
    dsect = clust2sect(dj.fs, dclst);

    dir = dj.fs->win;                       /* Initialize the new directory table */
    mem_set(dir, 0, SS(dj.fs));
    mem_set(dir+DIR_Name, ' ', 8+3);        /* Create "." entry */
    dir[DIR_Name] = '.';
    dir[DIR_Attr] = AM_DIR;
    tim = get_fattime();
    ST_DWORD(dir+DIR_WrtTime, tim);
    ST_WORD(dir+DIR_FstClusLO, dclst);
    ST_WORD(dir+DIR_FstClusHI, dclst >> 16);
    mem_cpy(dir+32, dir, 32);           /* Create ".." entry */
    dir[33] = '.';
    pclst = dj.sclust;
    if (dj.fs->fs_type == FS_FAT32 && pclst == dj.fs->dirbase)
        pclst = 0;
    ST_WORD(dir+32+DIR_FstClusLO, pclst);
    ST_WORD(dir+32+DIR_FstClusHI, pclst >> 16);
    for (n = 0; n < dj.fs->csize; n++) {    /* Write dot entries and clear left sectors */
        dj.fs->winsect = dsect++;
        dj.fs->wflag = 1;
        res = move_window(dj.fs, 0);
        if (res) LEAVE_FF(dj.fs, res);
        mem_set(dir, 0, SS(dj.fs));
    }

    res = dir_register(&dj);
    if (res != FR_OK) {
        remove_chain(dj.fs, dclst);
    } else {
        dir = dj.dir;
        dir[DIR_Attr] = AM_DIR;                 /* Attribute */
        ST_DWORD(dir+DIR_WrtTime, tim);         /* Crated time */
        ST_WORD(dir+DIR_FstClusLO, dclst);      /* Table start cluster */
        ST_WORD(dir+DIR_FstClusHI, dclst >> 16);
        dj.fs->wflag = 1;
        res = sync(dj.fs);
    }

    LEAVE_FF(dj.fs, res);
}




/*-----------------------------------------------------------------------*/
/* Change File Attribute                                                 */
/*-----------------------------------------------------------------------*/

FRESULT f_chmod (
    const XCHAR *path,  /* Pointer to the file path */
    BYTE value,         /* Attribute bits */
    BYTE mask           /* Attribute mask to change */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);
    BYTE *dir;


    res = chk_mounted(&path, &dj.fs, 1);
    if (res == FR_OK) {
        INITBUF(dj, sfn, lfn);
        res = follow_path(&dj, path);       /* Follow the file path */
        if (_FS_RPATH && res == FR_OK && (dj.fn[NS] & NS_DOT))
            res = FR_INVALID_NAME;
        if (res == FR_OK) {
            dir = dj.dir;
            if (!dir) {                     /* Is it a root directory? */
                res = FR_INVALID_NAME;
            } else {                        /* File or sub directory */
                mask &= AM_RDO|AM_HID|AM_SYS|AM_ARC;    /* Valid attribute mask */
                dir[DIR_Attr] = (value & mask) | (dir[DIR_Attr] & (BYTE)~mask); /* Apply attribute change */
                dj.fs->wflag = 1;
                res = sync(dj.fs);
            }
        }
    }

    LEAVE_FF(dj.fs, res);
}




/*-----------------------------------------------------------------------*/
/* Change Timestamp                                                      */
/*-----------------------------------------------------------------------*/

FRESULT f_utime (
    const XCHAR *path,  /* Pointer to the file/directory name */
    const FILINFO *fno  /* Pointer to the timestamp to be set */
)
{
    FRESULT res;
    DIR dj;
    NAMEBUF(sfn, lfn);
    BYTE *dir;


    res = chk_mounted(&path, &dj.fs, 1);
    if (res == FR_OK) {
        INITBUF(dj, sfn, lfn);
        res = follow_path(&dj, path);   /* Follow the file path */
        if (_FS_RPATH && res == FR_OK && (dj.fn[NS] & NS_DOT))
            res = FR_INVALID_NAME;
        if (res == FR_OK) {
            dir = dj.dir;
            if (!dir) {             /* Root directory */
                res = FR_INVALID_NAME;
            } else {                /* File or sub-directory */
                ST_WORD(dir+DIR_WrtTime, fno->ftime);
                ST_WORD(dir+DIR_WrtDate, fno->fdate);
                dj.fs->wflag = 1;
                res = sync(dj.fs);
            }
        }
    }

    LEAVE_FF(dj.fs, res);
}




/*-----------------------------------------------------------------------*/
/* Rename File/Directory                                                 */
/*-----------------------------------------------------------------------*/

FRESULT f_rename (
    const XCHAR *path_old,  /* Pointer to the old name */
    const XCHAR *path_new   /* Pointer to the new name */
)
{
    FRESULT res;
    DIR dj_old, dj_new;
    NAMEBUF(sfn, lfn);
    BYTE buf[21], *dir;
    DWORD dw;


    INITBUF(dj_old, sfn, lfn);
    res = chk_mounted(&path_old, &dj_old.fs, 1);
    if (res == FR_OK) {
        dj_new.fs = dj_old.fs;
        res = follow_path(&dj_old, path_old);   /* Check old object */
        if (_FS_RPATH && res == FR_OK && (dj_old.fn[NS] & NS_DOT))
            res = FR_INVALID_NAME;
    }
    if (res != FR_OK) LEAVE_FF(dj_old.fs, res); /* The old object is not found */

    if (!dj_old.dir) LEAVE_FF(dj_old.fs, FR_NO_FILE);   /* Is root dir? */
    mem_cpy(buf, dj_old.dir+DIR_Attr, 21);      /* Save the object information */

    mem_cpy(&dj_new, &dj_old, sizeof(DIR));
    res = follow_path(&dj_new, path_new);       /* Check new object */
    if (res == FR_OK) res = FR_EXIST;           /* The new object name is already existing */
    if (res == FR_NO_FILE) {                    /* Is it a valid path and no name collision? */
        res = dir_register(&dj_new);            /* Register the new object */
        if (res == FR_OK) {
            dir = dj_new.dir;                   /* Copy object information into new entry */
            mem_cpy(dir+13, buf+2, 19);
            dir[DIR_Attr] = buf[0] | AM_ARC;
            dj_old.fs->wflag = 1;
            if (dir[DIR_Attr] & AM_DIR) {       /* Update .. entry in the directory if needed */
                dw = clust2sect(dj_new.fs, (DWORD)LD_WORD(dir+DIR_FstClusHI) | LD_WORD(dir+DIR_FstClusLO));
                if (!dw) {
                    res = FR_INT_ERR;
                } else {
                    res = move_window(dj_new.fs, dw);
                    dir = dj_new.fs->win+32;
                    if (res == FR_OK && dir[1] == '.') {
                        dw = (dj_new.fs->fs_type == FS_FAT32 && dj_new.sclust == dj_new.fs->dirbase) ? 0 : dj_new.sclust;
                        ST_WORD(dir+DIR_FstClusLO, dw);
                        ST_WORD(dir+DIR_FstClusHI, dw >> 16);
                        dj_new.fs->wflag = 1;
                    }
                }
            }
            if (res == FR_OK) {
                res = dir_remove(&dj_old);          /* Remove old entry */
                if (res == FR_OK)
                    res = sync(dj_old.fs);
            }
        }
    }

    LEAVE_FF(dj_old.fs, res);
}

#endif /* !_FS_READONLY */
#endif /* _FS_MINIMIZE == 0 */
#endif /* _FS_MINIMIZE <= 1 */
#endif /* _FS_MINIMIZE <= 2 */



/*-----------------------------------------------------------------------*/
/* Forward data to the stream directly (Available on only _FS_TINY cfg)  */
/*-----------------------------------------------------------------------*/
#if _USE_FORWARD && _FS_TINY

FRESULT f_forward (
    FIL *fp,                        /* Pointer to the file object */
    UINT (*func)(const BYTE*,UINT), /* Pointer to the streaming function */
    UINT btr,                       /* Number of bytes to forward */
    UINT *bf                        /* Pointer to number of bytes forwarded */
)
{
    FRESULT res;
    DWORD remain, clst, sect;
    UINT rcnt;


    *bf = 0;

    res = validate(fp->fs, fp->id);                 /* Check validity of the object */
    if (res != FR_OK) LEAVE_FF(fp->fs, res);
    if (fp->flag & FA__ERROR)                       /* Check error flag */
        LEAVE_FF(fp->fs, FR_INT_ERR);
    if (!(fp->flag & FA_READ))                      /* Check access mode */
        LEAVE_FF(fp->fs, FR_DENIED);

    remain = fp->fsize - fp->fptr;
    if (btr > remain) btr = (UINT)remain;           /* Truncate btr by remaining bytes */

    for ( ;  btr && (*func)(NULL, 0);               /* Repeat until all data transferred or stream becomes busy */
        fp->fptr += rcnt, *bf += rcnt, btr -= rcnt) {
        if ((fp->fptr % SS(fp->fs)) == 0) {         /* On the sector boundary? */
            if (fp->csect >= fp->fs->csize) {       /* On the cluster boundary? */
                clst = (fp->fptr == 0) ?            /* On the top of the file? */
                    fp->org_clust : get_fat(fp->fs, fp->curr_clust);
                if (clst <= 1) ABORT(fp->fs, FR_INT_ERR);
                if (clst == 0xFFFFFFFF) ABORT(fp->fs, FR_DISK_ERR);
                fp->curr_clust = clst;              /* Update current cluster */
                fp->csect = 0;                      /* Reset sector address in the cluster */
            }
            fp->csect++;                            /* Next sector address in the cluster */
        }
        sect = clust2sect(fp->fs, fp->curr_clust);  /* Get current data sector */
        if (!sect) ABORT(fp->fs, FR_INT_ERR);
        sect += fp->csect - 1;
        if (move_window(fp->fs, sect))              /* Move sector window */
            ABORT(fp->fs, FR_DISK_ERR);
        fp->dsect = sect;
        rcnt = SS(fp->fs) - (WORD)(fp->fptr % SS(fp->fs));  /* Forward data from sector window */
        if (rcnt > btr) rcnt = btr;
        rcnt = (*func)(&fp->fs->win[(WORD)fp->fptr % SS(fp->fs)], rcnt);
        if (!rcnt) ABORT(fp->fs, FR_INT_ERR);
    }

    LEAVE_FF(fp->fs, FR_OK);
}
#endif /* _USE_FORWARD */



#if _USE_MKFS && !_FS_READONLY
/*-----------------------------------------------------------------------*/
/* Create File System on the Drive                                       */
/*-----------------------------------------------------------------------*/
#define N_ROOTDIR   512         /* Multiple of 32 and <= 2048 */
#define N_FATS      1           /* 1 or 2 */
#define MAX_SECTOR  131072000UL /* Maximum partition size */
#define MIN_SECTOR  2000UL      /* Minimum partition size */


FRESULT f_mkfs (
    BYTE drv,           /* Logical drive number */
    BYTE partition,     /* Partitioning rule 0:FDISK, 1:SFD */
    WORD allocsize      /* Allocation unit size [bytes] */
)
{
    static const DWORD sstbl[] = { 2048000, 1024000, 512000, 256000, 128000, 64000, 32000, 16000, 8000, 4000,   0 };
    static const WORD cstbl[] =  {   32768,   16384,   8192,   4096,   2048, 16384,  8192,  4096, 2048, 1024, 512 };
    BYTE fmt, m, *tbl;
    DWORD b_part, b_fat, b_dir, b_data;     /* Area offset (LBA) */
    DWORD n_part, n_rsv, n_fat, n_dir;      /* Area size */
    DWORD n_clst, d, n;
    WORD as;
    FATFS *fs;
    DSTATUS stat;


    /* Check validity of the parameters */
    if (drv >= _DRIVES) return FR_INVALID_DRIVE;
    if (partition >= 2) return FR_MKFS_ABORTED;

    /* Check mounted drive and clear work area */
    fs = FatFs[drv];
    if (!fs) return FR_NOT_ENABLED;
    fs->fs_type = 0;
    drv = LD2PD(drv);

    /* Get disk statics */
    stat = disk_initialize(drv);
    if (stat & STA_NOINIT) return FR_NOT_READY;
    if (stat & STA_PROTECT) return FR_WRITE_PROTECTED;
#if _MAX_SS != 512                      /* Get disk sector size */
    if (disk_ioctl(drv, GET_SECTOR_SIZE, &SS(fs)) != RES_OK
        || SS(fs) > _MAX_SS)
        return FR_MKFS_ABORTED;
#endif
    if (disk_ioctl(drv, GET_SECTOR_COUNT, &n_part) != RES_OK || n_part < MIN_SECTOR)
        return FR_MKFS_ABORTED;
    if (n_part > MAX_SECTOR) n_part = MAX_SECTOR;
    b_part = (!partition) ? 63 : 0;     /* Boot sector */
    n_part -= b_part;
    for (d = 512; d <= 32768U && d != allocsize; d <<= 1) ; /* Check validity of the allocation unit size */
    if (d != allocsize) allocsize = 0;
    if (!allocsize) {                   /* Auto selection of cluster size */
        d = n_part;
        for (as = SS(fs); as > 512U; as >>= 1) d >>= 1;
        for (n = 0; d < sstbl[n]; n++) ;
        allocsize = cstbl[n];
    }
    if (allocsize < SS(fs)) allocsize = SS(fs);

    allocsize /= SS(fs);        /* Number of sectors per cluster */

    /* Pre-compute number of clusters and FAT type */
    n_clst = n_part / allocsize;
    fmt = FS_FAT12;
    if (n_clst >= 0xFF5) fmt = FS_FAT16;
    if (n_clst >= 0xFFF5) fmt = FS_FAT32;

    /* Determine offset and size of FAT structure */
    switch (fmt) {
    case FS_FAT12:
        n_fat = ((n_clst * 3 + 1) / 2 + 3 + SS(fs) - 1) / SS(fs);
        n_rsv = 1 + partition;
        n_dir = N_ROOTDIR * 32 / SS(fs);
        break;
    case FS_FAT16:
        n_fat = ((n_clst * 2) + 4 + SS(fs) - 1) / SS(fs);
        n_rsv = 1 + partition;
        n_dir = N_ROOTDIR * 32 / SS(fs);
        break;
    default:
        n_fat = ((n_clst * 4) + 8 + SS(fs) - 1) / SS(fs);
        n_rsv = 33 - partition;
        n_dir = 0;
    }
    b_fat = b_part + n_rsv;         /* FATs start sector */
    b_dir = b_fat + n_fat * N_FATS; /* Directory start sector */
    b_data = b_dir + n_dir;         /* Data start sector */

    /* Align data start sector to erase block boundary (for flash memory media) */
    if (disk_ioctl(drv, GET_BLOCK_SIZE, &n) != RES_OK) return FR_MKFS_ABORTED;
    n = (b_data + n - 1) & ~(n - 1);
    n_fat += (n - b_data) / N_FATS;
    /* b_dir and b_data are no longer used below */

    /* Determine number of cluster and final check of validity of the FAT type */
    n_clst = (n_part - n_rsv - n_fat * N_FATS - n_dir) / allocsize;
    if (   (fmt == FS_FAT16 && n_clst < 0xFF5)
        || (fmt == FS_FAT32 && n_clst < 0xFFF5))
        return FR_MKFS_ABORTED;

    /* Create partition table if needed */
    if (!partition) {
        DWORD n_disk = b_part + n_part;

        mem_set(fs->win, 0, SS(fs));
        tbl = fs->win+MBR_Table;
        ST_DWORD(tbl, 0x00010180);      /* Partition start in CHS */
        if (n_disk < 63UL * 255 * 1024) {   /* Partition end in CHS */
            n_disk = n_disk / 63 / 255;
            tbl[7] = (BYTE)n_disk;
            tbl[6] = (BYTE)((n_disk >> 2) | 63);
        } else {
            ST_WORD(&tbl[6], 0xFFFF);
        }
        tbl[5] = 254;
        if (fmt != FS_FAT32)            /* System ID */
            tbl[4] = (n_part < 0x10000) ? 0x04 : 0x06;
        else
            tbl[4] = 0x0c;
        ST_DWORD(tbl+8, 63);            /* Partition start in LBA */
        ST_DWORD(tbl+12, n_part);       /* Partition size in LBA */
        ST_WORD(tbl+64, 0xAA55);        /* Signature */
        if (disk_write(drv, fs->win, 0, 1) != RES_OK)
            return FR_DISK_ERR;
        partition = 0xF8;
    } else {
        partition = 0xF0;
    }

    /* Create boot record */
    tbl = fs->win;                              /* Clear buffer */
    mem_set(tbl, 0, SS(fs));
    ST_DWORD(tbl+BS_jmpBoot, 0x90FEEB);         /* Boot code (jmp $, nop) */
    ST_WORD(tbl+BPB_BytsPerSec, SS(fs));        /* Sector size */
    tbl[BPB_SecPerClus] = (BYTE)allocsize;      /* Sectors per cluster */
    ST_WORD(tbl+BPB_RsvdSecCnt, n_rsv);         /* Reserved sectors */
    tbl[BPB_NumFATs] = N_FATS;                  /* Number of FATs */
    ST_WORD(tbl+BPB_RootEntCnt, SS(fs) / 32 * n_dir); /* Number of rootdir entries */
    if (n_part < 0x10000) {                     /* Number of total sectors */
        ST_WORD(tbl+BPB_TotSec16, n_part);
    } else {
        ST_DWORD(tbl+BPB_TotSec32, n_part);
    }
    tbl[BPB_Media] = partition;                 /* Media descripter */
    ST_WORD(tbl+BPB_SecPerTrk, 63);             /* Number of sectors per track */
    ST_WORD(tbl+BPB_NumHeads, 255);             /* Number of heads */
    ST_DWORD(tbl+BPB_HiddSec, b_part);          /* Hidden sectors */
    n = get_fattime();                          /* Use current time as a VSN */
    if (fmt != FS_FAT32) {
        ST_DWORD(tbl+BS_VolID, n);              /* Volume serial number */
        ST_WORD(tbl+BPB_FATSz16, n_fat);        /* Number of secters per FAT */
        tbl[BS_DrvNum] = 0x80;                  /* Drive number */
        tbl[BS_BootSig] = 0x29;                 /* Extended boot signature */
        mem_cpy(tbl+BS_VolLab, "NO NAME    FAT     ", 19);  /* Volume lavel, FAT signature */
    } else {
        ST_DWORD(tbl+BS_VolID32, n);            /* Volume serial number */
        ST_DWORD(tbl+BPB_FATSz32, n_fat);       /* Number of secters per FAT */
        ST_DWORD(tbl+BPB_RootClus, 2);          /* Root directory cluster (2) */
        ST_WORD(tbl+BPB_FSInfo, 1);             /* FSInfo record offset (bs+1) */
        ST_WORD(tbl+BPB_BkBootSec, 6);          /* Backup boot record offset (bs+6) */
        tbl[BS_DrvNum32] = 0x80;                /* Drive number */
        tbl[BS_BootSig32] = 0x29;               /* Extended boot signature */
        mem_cpy(tbl+BS_VolLab32, "NO NAME    FAT32   ", 19);    /* Volume lavel, FAT signature */
    }
    ST_WORD(tbl+BS_55AA, 0xAA55);               /* Signature */
    if (SS(fs) > 512U) {
        ST_WORD(tbl+SS(fs)-2, 0xAA55);
    }
    if (disk_write(drv, tbl, b_part+0, 1) != RES_OK)
        return FR_DISK_ERR;
    if (fmt == FS_FAT32)
        disk_write(drv, tbl, b_part+6, 1);

    /* Initialize FAT area */
    for (m = 0; m < N_FATS; m++) {
        mem_set(tbl, 0, SS(fs));        /* 1st sector of the FAT  */
        if (fmt != FS_FAT32) {
            n = (fmt == FS_FAT12) ? 0x00FFFF00 : 0xFFFFFF00;
            n |= partition;
            ST_DWORD(tbl, n);               /* Reserve cluster #0-1 (FAT12/16) */
        } else {
            ST_DWORD(tbl+0, 0xFFFFFFF8);    /* Reserve cluster #0-1 (FAT32) */
            ST_DWORD(tbl+4, 0xFFFFFFFF);
            ST_DWORD(tbl+8, 0x0FFFFFFF);    /* Reserve cluster #2 for root dir */
        }
        if (disk_write(drv, tbl, b_fat++, 1) != RES_OK)
            return FR_DISK_ERR;
        mem_set(tbl, 0, SS(fs));        /* Following FAT entries are filled by zero */
        for (n = 1; n < n_fat; n++) {
            if (disk_write(drv, tbl, b_fat++, 1) != RES_OK)
                return FR_DISK_ERR;
        }
    }

    /* Initialize Root directory */
    m = (BYTE)((fmt == FS_FAT32) ? allocsize : n_dir);
    do {
        if (disk_write(drv, tbl, b_fat++, 1) != RES_OK)
            return FR_DISK_ERR;
    } while (--m);

    /* Create FSInfo record if needed */
    if (fmt == FS_FAT32) {
        ST_WORD(tbl+BS_55AA, 0xAA55);
        ST_DWORD(tbl+FSI_LeadSig, 0x41615252);
        ST_DWORD(tbl+FSI_StrucSig, 0x61417272);
        ST_DWORD(tbl+FSI_Free_Count, n_clst - 1);
        ST_DWORD(tbl+FSI_Nxt_Free, 0xFFFFFFFF);
        disk_write(drv, tbl, b_part+1, 1);
        disk_write(drv, tbl, b_part+7, 1);
    }

    return (disk_ioctl(drv, CTRL_SYNC, (void*)NULL) == RES_OK) ? FR_OK : FR_DISK_ERR;
}

#endif /* _USE_MKFS && !_FS_READONLY */




#if _USE_STRFUNC
/*-----------------------------------------------------------------------*/
/* Get a string from the file                                            */
/*-----------------------------------------------------------------------*/
char* f_gets (
    char* buff, /* Pointer to the string buffer to read */
    int len,    /* Size of string buffer */
    FIL* fil    /* Pointer to the file object */
)
{
    int i = 0;
    char *p = buff;
    UINT rc;


    while (i < len - 1) {           /* Read bytes until buffer gets filled */
        f_read(fil, p, 1, &rc);
        if (rc != 1) break;         /* Break when no data to read */
#if _USE_STRFUNC >= 2
        if (*p == '\r') continue;   /* Strip '\r' */
#endif
        i++;
        if (*p++ == '\n') break;    /* Break when reached end of line */
    }
    *p = 0;
    return i ? buff : NULL;         /* When no data read (eof or error), return with error. */
}



#if !_FS_READONLY
#include <stdarg.h>
/*-----------------------------------------------------------------------*/
/* Put a character to the file                                           */
/*-----------------------------------------------------------------------*/
int f_putc (
    int chr,    /* A character to be output */
    FIL* fil    /* Ponter to the file object */
)
{
    UINT bw;
    char c;


#if _USE_STRFUNC >= 2
    if (chr == '\n') f_putc ('\r', fil);    /* LF -> CRLF conversion */
#endif
    if (!fil) { /* Special value may be used to switch the destination to any other device */
    /*  put_console(chr);   */
        return chr;
    }
    c = (char)chr;
    f_write(fil, &c, 1, &bw);   /* Write a byte to the file */
    return bw ? chr : EOF;      /* Return the result */
}




/*-----------------------------------------------------------------------*/
/* Put a string to the file                                              */
/*-----------------------------------------------------------------------*/
int f_puts (
    const char* str,    /* Pointer to the string to be output */
    FIL* fil            /* Pointer to the file object */
)
{
    int n;


    for (n = 0; *str; str++, n++) {
        if (f_putc(*str, fil) == EOF) return EOF;
    }
    return n;
}




/*-----------------------------------------------------------------------*/
/* Put a formatted string to the file                                    */
/*-----------------------------------------------------------------------*/
int f_printf (
    FIL* fil,           /* Pointer to the file object */
    const char* str,    /* Pointer to the format string */
    ...                 /* Optional arguments... */
)
{
    va_list arp;
    UCHAR c, f, r;
    ULONG val;
    char s[16];
    int i, w, res, cc;


    va_start(arp, str);

    for (cc = res = 0; cc != EOF; res += cc) {
        c = *str++;
        if (c == 0) break;          /* End of string */
        if (c != '%') {             /* Non escape cahracter */
            cc = f_putc(c, fil);
            if (cc != EOF) cc = 1;
            continue;
        }
        w = f = 0;
        c = *str++;
        if (c == '0') {             /* Flag: '0' padding */
            f = 1; c = *str++;
        }
        while (c >= '0' && c <= '9') {  /* Precision */
            w = w * 10 + (c - '0');
            c = *str++;
        }
        if (c == 'l') {             /* Prefix: Size is long int */
            f |= 2; c = *str++;
        }
        if (c == 's') {             /* Type is string */
            cc = f_puts(va_arg(arp, char*), fil);
            continue;
        }
        if (c == 'c') {             /* Type is character */
            cc = f_putc(va_arg(arp, int), fil);
            if (cc != EOF) cc = 1;
            continue;
        }
        r = 0;
        if (c == 'd') r = 10;       /* Type is signed decimal */
        if (c == 'u') r = 10;       /* Type is unsigned decimal */
        if (c == 'X') r = 16;       /* Type is unsigned hexdecimal */
        if (r == 0) break;          /* Unknown type */
        if (f & 2) {                /* Get the value */
            val = (ULONG)va_arg(arp, long);
        } else {
            val = (c == 'd') ? (ULONG)(long)va_arg(arp, int) : (ULONG)va_arg(arp, unsigned int);
        }
        /* Put numeral string */
        if (c == 'd') {
            if (val & 0x80000000) {
                val = 0 - val;
                f |= 4;
            }
        }
        i = sizeof(s) - 1; s[i] = 0;
        do {
            c = (UCHAR)(val % r + '0');
            if (c > '9') c += 7;
            s[--i] = c;
            val /= r;
        } while (i && val);
        if (i && (f & 4)) s[--i] = '-';
        w = sizeof(s) - 1 - w;
        while (i && i > w) s[--i] = (f & 1) ? '0' : ' ';
        cc = f_puts(&s[i], fil);
    }

    va_end(arp);
    return (cc == EOF) ? cc : res;
}

#endif /* !_FS_READONLY */
#endif /* _USE_STRFUNC */
